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inertial  sensor  error  model  coefficients  from  a  dynamic  laboratory  calibration 
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the  error  model  coefficients  of  inertial  grade  sensors  are  from  one  to  four 
orders  of  magnitude  smaller  than  the  fixed  and  first-order  terms.  To  obtain 
measurable  quantities  of  these  error  sources  requires  the  application  of 
precise  high-acceleration  inputs  from  a  laboratory  test  device.  Until  1971, 
there  were  no  laboratory  test  devices  that  maintained  a  low  angular-rate 
environment  while  providing  precise  high-acceleration  inputs  to  permit  recovi  ry 
of  the  high-order  gyro  compliance  terms.  In  1971,  the  United  States  Air  Force 
completed  the  260-inch  Radius  Precision  Centrifuge  which  is  located  at  the 
Central  Inertial  Guidance  Test  Facility,  Holloman  AFB,  New  Mexico.  The 
unique  feature  of  this  centrifuge  that  permits  high-.icceleration  testing  of  gyros 
and/or  systems  is  that  the  test  specimen  is  located  on  a  counter-rotating  plat¬ 
form  that  isolates  the  gyros  from  the  centrifuge  angular  rate.  Unfortunately, 
accurate  estimates  of  the  error  terms  require  more  than  a  precision  lest  device. 
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Iu  addition  to  the  test  device,  one  must  have  a  positively  controlled  test  proce¬ 
dure  that  varies  the  system  orientation  with  respect  to  the  input  acceleration  to 
provide  better  observation  of  the  error  coefficients  in  the  measurement  data  and 
a  data  reduction  program  that  provides  the  "best"  estimates  of  the  error  coeffi¬ 
cients  from  noisy  measurement  data.  This  report  proposes  a  dynamic  test 
procedure  and  an  associated  data  reduction  method  for  obtaining  estimates  of 
the  error  model  coefficients  from  a  260-inch  Centrifuge  System  Test. 


The  dynamic  test  procedure  is  obtained  by  command  torquing  the  platform  gyros 
to  drive  the  platform  through  a  prespecified  torque  profile  so  that  each  axis  is 
subjected  to  the  applied  acceleration.  Since  the  platform  motion  is  a  combina¬ 
tion  of  commanded  rate,  applied  earth-rate,  and  drift  due  to  the  gyro  error 
terms,  tracking  the  platform  motion  with  Euler  angle  rates  provides  the  basis 
for  the  state  dynamics.  The  measurements,  obtained  from  the  triad  of  plat¬ 
form  accelerometers,  are  functions  of  the  accelerometer  error  terms  and  the 
Euler  angles,  which  in  turn  contain  the  drift  motion  due  to  the  gyro  error 
coefficients.  Therefore,  the  problem  is  a  parameter  estimation  problem  where 
the  Euler  angles  and  error  model  coefficients  are  designed  as  system  states  to 
be  estimated  from  noisy  measurements.  Since  both  the  state  and  measurement 
equations  are  nonlinear  functions  of  the  state  variables,  an  Extended  Kalman 
Filter  is  applied. 


The  results  of  two  simulations  verify  the  application  of  the  filtering  algorithm 
to  the  calibration  problem.  The  results  show  that  significant  improvement  can 
be  obtained  in  reducing  the  time  required  to  calibrate  an  Inertial  Navigation 
System.  In  addition,  a  method  of  applying  the  off-diagonal  terms  of  the  filtering 
error  covariance  matrix  provides  a  new  dimension  in  evaluating  filter  perfor¬ 
mance  with  respect  to  system  observability. 
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ABSTRACT 


The  report  describes  a  data  reduction  technique  that  obtains 
estimates  of  inertial  sensor  error  model  coefficients  from  a  dynamic  labora¬ 
tory  calibration  of  a  typical  Inertial  Navigation  System.  The  error  model 
coefficients  are  those  associated  with  gyros,  accelerometers,  and  their 
misalignment  errors  that  have  been  found  by  test  and  analysis  to  be  the  pre¬ 
dominant  sources  of  error  affecting  system  accuracy.  All  the  error  terms 
considered  are  categorized  as  either  fixed  (independent  of  applied  accelera¬ 
tion),  first-order  (proportional  to  the  first  power  of  acceleration),  or  higher- 
order  terms,  which  are  proportional  to  the  square  or  cube  of  acceleration. 

In  the  case  of  the  higher-order  terms,  the  error  model  coefficients  of  inertial 
grade  sensors  are  from  one  to  four  orders  of  magnitude  smaller  than  the  fixed 
and  first-order  terms.  To  obtain  measurable  quantities  of  these  error 
sources  requires  the  application  of  precise  high-acceleration  inputs  from  a 
laboratory  test  device.  Until  1971,  there  were  no  laboratory  test  devices 
that  maintained  a  low  angular- rate  environment  while  providing  precise  high- 
acceleration  inputs  to  permit  recovery  of  the  nigh-order  gyro  compliance 
terms.  In  1971,  the  United  States  Air  Force  completed  the  260-inch  Radius 
Precision  Centrifuge  which  is  located  at  the  Central  Inertial  Guidance  Test 
Facility,  Holloman  AFB,  New  Mexico.  The  unique  feature  of  this  centrifuge 
that  permits  high-acceleration  testing  of  gyros  and/or  systems  is  that  the 
test  specimen  is  located  on  a  counter-rotating  platform  that  isolates  the 
gyros  from  the  centrifuge  angular  rate.  Unfortunately,  accurate  estimates 
of  the  error  terms  require  more  than  a  precision  test  device.  In  addition  to 
the  test  device,  one  must  have  a  positively  controlled  test  procedure  that 
varies  the  system  orientation  with  respect  to  the  input  acceleration  to  provide 
better  observation  of  the  error  coefficients  in  the  measurement  data  and  a 
data  reduction  program  that  provides  the  "best"  estimates  of  the  error 
coefficients  from  noisy  measurement  data.  This  report  proposes  a  dynamic 
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test  procedure  and  an  associated  data  reduction  method  for  obtaining 
estimates  of  the  error  model  coefficients  from  a  260-inch  Centrifuge  System 
Test. 

The  dynamic  test  procedure  is  obtained  by  command  torquing  the 
platform  gyros  to  drive  the  platform  through  a  prespecified  torque  profile 
so  that  each  axis  is  subjected  to  the  applied  acceleration.  Since  the  platform 
motion  is  a  combination  of  commanded  rate,  applied  earth-rate,  and  drift  due 
to  the  gyro  error  terms,  tracking  the  platform  motion  with  Euler  angle  rates 
provides  the  basis  for  the  state  dynamics.  The  measurements,  obtained 
from  the  triad  of  platform  accelerometers,  are  functions  of  the  acceler¬ 
ometer  error  terms  and  the  Euler  angles,  which  in  turn  contain  the  drift 
motion  due  to  the  gyro  error  coefficients.  Therefore,  the  problem  is  a 
parameter  estimation  problem  where  the  Euler  angles  and  error  model 
coefficients  are  designed  as  system  states  to  be  estimated  from  noisy 
measurements.  Since  both  the  state  and  measurement  equations  are  non¬ 
linear  functions  of  the  state  variables,  an  Extended  Kalman  Filter  is  applied. 

The  results  of  two  simulations  verify  the  application  of  the  filtering 
algorithm  to  the  calibration  problem.  The  results  show  that  significant 
improvement  can  be  obtained  in  reducing  the  time  required  to  calibrate  an 
Inertial  Navigation  System.  In  addition,  a  method  of  applying  the  off- 
diagonal  terms  of  the  filtering  error  covariance  matrix  provides  a  new 
dimension  in  evaluating  filter  performance  with  respect  to  system 
observability. 
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SECTION  1 


INTRODUCTION 


1.1  OBJECTIVE 

The  objective  of  the  report  is  to  develop  a  data  reduction 
technique  that  obtains  estimates  of  inertial  sensor  error  model  coeffi¬ 
cients  from  a  dynamic  laboratory  calibration  of  a  typical  Inertial  Navi¬ 
gation  System  (INS).  The  error  model  coefficients  are  those  associated 
with  the  error  sources  that  affect  the  ability  of  the  inertial  system  to 
measure  accurately  the  velocity,  position,  or  attitude  profile  of  the 
inertially  guided  vehicle.  These  inertial  measurement  errors  are 
represented  by  gyro,  accelerometer,  and  alignment  errors;  they 
have  been  found  by  test  and  analysis  to  be  the  predominant  sources  of 
error  affecting  system  accuracy  [1,2].  Present  day  accuracy  require¬ 
ments  for  inertial  navigators  are  so  stringent  that  gyro  and  acceler¬ 
ometer  component  manufacturing  has  reached  the  state-of-the-art  in 
material  selection,  production  tolerances,  and  assembly  techniques. 
The  cost  of  product  improvement  has  become  intolerable.  Other  than 
searching  for  completely  new  developments  in  sensor  design,  the  most 
feasible  approach  to  the  problem  is  to  find  test  and  data  reduction  tech¬ 
niques  that  accurately  determine  all  measurable  sensor  error  sources. 
Once  these  errors  are  measured,  a  systems  approach  can  be  taken  to 
either  compensate  for  the  errors  or  select  a  system  configuration  or 
mission  profile  that  minimizes  the  effects  of  these  errors  on  system 
accuracy.  Computational  schemes  in  airborne  computers  have  become 
sophisticated  enough  to  permit  accurate  compensation  for  bias  and 
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scale-factor  errors  for  each  accelerometer,  provide  fpr  precision 
torquing  of  platform  gyros  to  compensate  for  ’1*ed  -  restraint  gyro 
drift,  and  finally  to  perform  coordinate  transformations  to  account  for 
sensor  misalignments.  However,  this  assumes  that  accurate  knowl¬ 
edge  of  each  error  coefficient  is  available  for  insertion  in  the  naviga¬ 
tion  software  program.  Gyro  mass  unbalance  terms  are  usually  com¬ 
pensated  by  physical  adjustment  of  gyro-float-trim  weights  via  a 
remote  adjustment  mechanism.  All  the  error  terms  discussed  thus 
far  are  categorized  as  either  fixed  (i.e.,  independent  of  acceleration) 
or  first-order  terms  (i.e.,  proportional  to  the  first  power  of  accelera¬ 
tion);  they  are  the  only  error  categories  where  compensation  techniques 
are  practical.  Therefore,  the  purpose  of  obtaining  accurate  estimates 
of  these  error  model  coefficients,  obviously,  is  to  directly  improve 
system  performance  through  error  compensation.  Higher-order  error 
terms  that  are  proportional  to  the  square  or  cube  of  acceleration  are 
obtained  for  incorporation  into  system  error  analysis  programs  so  that 
their  effects  on  system  accuracy  can  be  ascertained.  In  addition, 
these  error  sources  are  also  used  in  flight  simulation  programs  to 
determine  the  best  sensor  orientations,  platform  orientation,  and  mis¬ 
sion  profiles  for  minimizing  the  effects  of  these  error  sources  on  sys¬ 
tem  performance.  Therefore,  the  purpose  of  obtaining  accurate  esti¬ 
mates  of  the  higher-order  error  model  coefficients  is  to  provide  for 
system  accuracy  determination  and  design  optimization. 

1.2  PROBLEM  DESCRIPTION 

Accurate  estimates  of  the  fixed  and  first-order  coefficients  can 
be  obtained  by  using  present  day  laboratory  test  methods  in  which  the 
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system  is  precisely  positioned  and  rotated  with  respect  to  the 
earth-rate  and  local-gravity  vectors,  quantities  which  are  accurately 
determined  at  the  test  site.  Sufficient  measurements  of  the  system 
output  are  taken  to  permit  the  performance  of  a  least-squares- 
regression  analysis  on  the  measurement  data  with  respect  to  a  math¬ 
ematical  model  of  the  system  output.  The  math  model  is  a  function  of 
the  desired  error  model  coefficients  and  the  applied  earth-rate  and 
local-gravity  vector  components.  In  the  case  of  the  higher-order 
error  terms,  the  error  model  coefficients  of  inertial  grade  sensors 
are  from  one  to  four  orders  of  magnitude  smaller  than  the  fixed  and 
first-order  terms.  Obtaining  measurable  quantities  of  these  error 
sources  requires  the  application  of  precise  high-acceleration  inputs 
from  the  laboratory  test  device.  Accelerometer  error  terms  have 
been  obtained  quite  successfully  since  1962,  utilizing  precision  centri¬ 
fuges  that  have  the  capability  of  applying  precise  acceleration  over  the 
range  of  1  to  28  g's  (i.e.,  28  times  the  magnitude  of  the  local-gravity 
vector).  Gyros  developed  for  platform  stabilization  systems  are 
specifically  designed  for  a  very  low  angular-rate  profile.  Therefore, 
the  centrifuge  environment  is  not  compatible  with  the  gyro  design, 
since  a  10-  to  20-arc-seccnd  misalignment  of  the  gyro  input-axis  with 
respect  to  the  centrifuge  rotational  plane  can  couple  enough  of  the 
centrifuge  angular  rate  into  the  gyro  to  completely  mask  the  rate  con¬ 
tribution  of  the  desired  error  source  terms  and,  in  some  instances, 
cause  output  saturation  or  destruction  of  the  gyro  bearing.  Until  1971, 
there  were  no  laboratory  test  devices  that  maintained  a  low  angular- 
rate  environment  while  providing  precise  high-acceleration  inputs  to 
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permit  recovery  of  the  high-order  gyro  compliance  terms.  In  1971, 
after  a  nine-year  development,  the  United  States  Air  Force  completed 
the  260-inch  radius  precision  centrifuge  (Reference  Figure  1.1),  which 
is  located  at  the  Central  Inertial  Guidance  Test  Facility,  Holloman  Air 
Force  Base,  New  Mexico  [3],  The  260-inch  centrifuge  has  the  capa¬ 
bility  of  testing  both  gyro  and  accelerometer  inertial  sensors,  as  well 
as  complete  navigational  systems.  The  unique  feature  of  this  centri¬ 
fuge,  which  permits  high-g  acceleration  testing  of  gyros,  is  that  the 
test  specimen  is  on  a  counter-rotating  platform  (CRP),  which  isolates 
the  gyros  from  the  centrifuge  angular  rate,  since  the  CRP  rotates  at 
the  same  rate  but  in  opposition  to  the  centrifuge  main  arm.  Therefore, 
under  perfect  counter-rotation,  the  azimuth  of  the  system  under  test 
remains  fixed  with  respect  to  an  earth  reference  frame.  The  accelera¬ 
tion  applied  to  the  system  is  a  low  frequency  sinusoid  with  a  zero  to 
peak  magnitude  from  0.25  to  100  g's.  The  frequency  of  oscillation  is 
less  than  2  Hz  and  should  be  well  within  the  system-gimbal- servo 
response  so  that  there  is  no  interference  with  the  system  stabilization 
function.  The  260-inch  centrifuge  provides  for  the  first  time  the  pre¬ 
cise  high-g  environment  necessary  to  validate  and  accurately  estimate 
for  a  complete  navigational  system  the  sensor  error  model  coefficients 
proportional  to  acceleration.  Unfortunately,  accurate  estimates  of  the 
error  model  coefficients  require  more  than  a  precision  test  device. 

In  addition  to  the  test  device,  one  must  have  (a)  a  positively  controlled 
test  procedure  that  varies  the  system  orientation  with  respect  to  the 
input  acceleration  to  provide  better  observation  of  the  error  coefficients 
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in  the  measurement  data;  (b)  a  data  collection  scheme  that  does  not 
corrupt  the  measurement  data;  and  (c)  a  data  reduction  program  that 
provides  the  "best"  estimates  of  the  error  coefficients  from  noisy 
measurement  data.  The  data  processing  problem  is  not  considered  in 
this  report,  since  it  is  highly  dependent  on  the  particular  system 
being  tested  and  the  data  acquisition  equipment  available  in  the  labora¬ 
tory.  The  problem  considered  is  to  develop  a  dynamic  test  procedure 
and  an  associated  data  reduction  method  for  obtaining  estimates  of  the 
error  model  coefficients  from  a  260-inch  centrifuge  system  test.  The 
end  product  of  the  test  program  is  to  provide  a  dynamic  laboratory 
calibration  that  identifies  all  the  significant  acceleration  error 
sources  of  the  Inertial  Navigation  System. 

1 . 3  PROBLEM  APPROACH 

The  stabilization  function  of  an  Inertial  Navigation  System  pro¬ 
vides  base  motion  isolation  of  the  inner  gimbal  or  platform  where  the 
inertial  sensors  are  located.  Any  angular  motion  of  the  base  or  mount 
ing  frame  of  the  INS  is  transmitted  through  the  outer  system  gimbals 
to  the  inner  platform,  where  it  is  sensed  by  the  triad  of  single-degrce- 
of -freedom  integrating  gyros.  The  gyro  outputs  are  sent  to  the  gimbal 
stabilization  loops,  which  consist  of  stabilization  amplifiers  driving 
gimbal  torque  motors.  The  end  result  is  that,  through  rotation  of  the 
gimbals  by  the  gimbal  torque  motors,  the  inner  platform  is  driven  in 
such  a  way  as  to  null  the  gyro  output  signals  so  that  the  inner  platform 
remains  fixed  with  respect  to  inertial  space  or  any  other  specified 
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navigational  reference  frame.  The  gyro  output  angular  rate  can  be 
represented  by  the  following  performance  model: 

wOi  =  ^DF  +  DIaI  +  DOaO  +  DSaS  +  DIIaI  +  DOOaO  +  DSSaS 

+  DI0aiaO  +  DlSaIaS  +  DOSaOas)  +  W1  +  WCMD  (1*  l) 

where 

Wqj  =  output  angular  rate  of  the  ith  gyro 

D_  =  fixed  restraint  drift 
F 

Dj,  Dq,  Dg  -  mass  unbalance  drift  coefficients 

DII’  DoO’  ^SS’  ^io*  DIS’  ^OS  "  compl*ance  drift  coefficients 

aj,  a^,  ag  -  applied  acceleration  along  the  gyro  input,  output, 
and  spin  axes,  respectively 

Wj  =  applied  rate  about  the  gyro  input  axis 

WCMD  =  commanded  angular  rate  due  to  command  torque  applied 
to  gyro  torque  generator 

Neglecting  the  commanded  angular  rate  for  now,  the  bracketed  terms 
in  Eq.  (1.1)  cause  the  inner  platform  to  drift  from  the  navigational 
reference  frame,  since  they  are  not  a  function  of  input  angular  rate, 
but  are  generated  by  error  sources  internal  to  the  gyro.  In  fact,  these 
are  the  gyro  error  model  coefficients  that  are  to  be  identified. 
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Assuming  that  the  applied  rate  about  the  gyro  input  axis  is  known,  the 
angular  motion  of  the  platform  with  respect  to  the  base  mounting  frame 
(which  is  equal  in  magnitude  but  opposite  in  direction  to  the  gyro  output 
angular  rate)  will  be  a  function  of  the  gyro  error  model  coefficients  and 
the  applied  acceleration.  The  applied  acceleration  for  a  260-inch 
centrifuge  test  will  be  a  combination  of  the  local  gravitational  and 
kinematic  accelerations.  Tracking  the  platform  motion  with  respect 
to  a  mounting  frame,  located  on  the  counter-rotating  platform  of  the 
centrifuge,  provides  the  basis  for  the  dynamics  of  the  system  calibra¬ 
tion  problem.  The  platform  3-degrces-of-freedom  motion  can  be 
described  in  terms  of  three  Euler  angle  rates.  Numerous  laboratory 
tests  of  inertial  sensors  have  shown  that  the  actual  physical  system 
error  coefficients  are  best  described  by  a  stochastic  process  whose 
behavior  at  any  given  time  is  adequately  described  by  a  Gaussiar  dis¬ 
tribution  [4,  5, 6],  Therefore,  the  problem  is  an  identification  or 
parameter  estimation  problem,  where  the  Euler  angles  and  error 
model  coefficients  are  designated  as  system  state  variables  to  be  esti¬ 
mated  from  noisy  measurements.  Before  discussing  the  measurement 
dynamics,  it  should  be  noted  that  the  accelerations  in  Eq.  (1.1)  are 
defined  in  the  sensor  frame  that  is  fixed  to  the  inner  platform;  there¬ 
fore,  the  accelerations  will  be  functions  of  the  Euler  angle  states. 
Therefore,  the  evolution  of  the  system's  state  with  time  will  be  a  non¬ 
linear  function  of  the  state  variables.  One  of  the  INS  outputs  is  usually 
the  integral  of  the  accelerations  sensed  by  the  triad  of  accelerometers 
mounted  on  the  inner  platform.  Sim  e  the  system  output  interfaces  with 
an  airborne*  digital  computer,  the  velocity  is  quantized  into  velocity 
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pulses  that  are  counted  over  some  measurement  interval.  The  output  is 
therefore  the  velocity  change  over  the  sample  interval.  This  implies 
that  the  measurement  dynamic  equations  are  discrete -time  processes. 
The  relationship  between  the  system  dynamics  and  the  measurement 
sequence  can  be  seen  fr-_  m  the  following  model  of  an  accelerometer 
output. 


IND 


*  Ko  + 


Klal  + 


K3al 


KIPaiaP 


(1.2) 


where 


aIND  =  ^nc^lcate^  output  of  the  ith  accelerometer 


Kq  =  bias 


Kj  =  scale  factor 

K^,  -  nonlinear  coefficients 

Kjp  =  cross -axis  nonlinearity 

a.y  ap  -  applied  acceleration  along  the  accelerometer  input  and 
pendulous  axes,  respectively 


The  K-terms  are  the  accelerometer  error  model  coefficients  to  be 
identified;  therefore,  they  will  be  designated  as  state  variables.  The 
definition  of  the  accelerations  in  Eq.  (1.2)  in  the  sensor  frame  implies 
that  they  will  be  functions  of  the  Euler  angle  states.  This  in  turn 
implies  the  following  properties  for  the  measurement  sequence:  (a)  the 
measurement  dynamics  will  be  a  nonlinear  function  of  the  state  vari¬ 
ables,  and  (b)  since  the  Euler  angles  depict  the  platform  position  at 
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any  point  in  time,  the  Euler  angle  states  in  the  measurement 
sequence  contain  the  dynamic  motion  generated  by  the  gyro  error 
coefficient  states.  Adequately  representing  all  the  error  coefficient 
states  in  the  measurement  sequence  implies  that  the  platform  motion 
must  be  positively  controlled  to  orient  each  sensor  axis  with  respect 
to  the  applied  acceleration.  If  the  platform  motion  is  limited  to  the 
benign  motion  of  the  random  drift  plus  earth  rate,  an  observability 
problem  could  occur  with  some  of  the  error  states.  To  overcome  this 
problem,  one  must  use  the  term  in  Eq.  (1 .  1 )  to  drive  the  plat¬ 

form  through  a  prespecified  torque  profile  so  that  each  axis  of  the 
platform  is  subjected  to  the  applied  acceleration.  The  commanded 
gyro  output  is  generated  by  applying  a  prespecified  signal  to  the  inter¬ 
nal  gyro  torque  generator.  This  dynamic  test  procedure  permits  com¬ 
plete  rotational  control  of  the  platform  so  that  adequate  representation 
of  the  contribution  due  to  each  error  state  can  be  obtained  in  the  mea¬ 
surement  sequence.  Since  both  the  state  and  measurement  dynamics 
are  nonlinear  functions  of  the  state  variables,  an  extended  Kalman  fil¬ 
ter  will  be  applied  to  linearize  the  state  and  measurement  trajectories 
about  the  optimal  filtered  estimates. 

This  dynamic  test  procedure,  in  conjunction  with  the  filtering 
process,  will  provide,  for  the  first  time  at  the  Central  Inertial 
Guidance  Test  Facility,  the  capability  of  on-line  system  calibrations. 
The  advantage  of  on-line  data  reduction  is  that  the  test  procedure,  the 
assumed  system  models,  and  the  significance  of  the  state  estimates 
can  be  evaluated  while  the  system  is  under  test. 
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1 . 4  SCOPE  OF  EFFORT 


The  scope  of  the  report  i ■*  as  fellows: 

(a)  Development  of  iie  system  and  measurement  dynamic 
equations  for  a  <  ample te  Inertial  Navigation  System  Cen¬ 
trifuge  Test  Program.  This  task  includes  the  inertial  sen¬ 
sor  error  model  equations,  the  platform  rate  equations, 
the  kinematic  and  gravitational  acceleration  equations 
with  the  corresponding  centrifuge  coordinate  transforma¬ 
tions,  and  finally  the  Euler  rate  equations  for  tracking  the 
platform  motion. 

(b)  Development  of  the  extended  Kalman  filter  equations. 

(c)  Evaluation  of  the  data  reduction  technique  via  the  follow¬ 
ing  simulations: 

(1)  The  normal  centrifuge  test  program  consists  of  a  1-g 
calibration  in  the  local  gravitational  field  prior  to  and 
immediately  following  the  operating  centrifuge  test. 

The  purpose  of  this  test  is  to  determine  the  overall 
effect  of  the  centrifuge  environment  on  the  fixed  and 
first-order  error  coefficients,  which  are  the  major 
error  sources.  A  simulation  of  the  1-g  calibration 
program,  consisting  of  17  state  variables,  was  made, 
using  the  same  techniques  proposed  for  the  operating 
centrifuge  test. 

(2)  A  10-state  variable  simulation  was  made  of  the  centri¬ 
fuge  operating  at  the  10-g  level  to  determine  the  ability 
of  the  filter  to  identify  the  higher-order  error 
coefficients. 
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So  that  the*  error  model  coelUcients  in  these  simulations  are 


representative  ot  an  actual  physical  system,  the  Carousel  VB  Inertial 
Measurement  Unit  developed  by  Delco  Electronics  was  selected  as  the 
baseline  Inertial  Navigation  System,  since  it  is  representative  of  the 
type  of  Inertial  Guidance  System  being  used  in  both  ballistic  missile 
and  aircraft  navigation  applications.  The  United  States  Air  Force 
selected  the  Carousel  VB  for  use  in  their  Titan  IIIC  series  of  launch 
vehicles.  The  Carousel  IV,  which  is  similar  to  the  Model  VB,  is 
presently  installed  in  the  Boeing  Models  747  and  707,  and  McDonnell 
Douglas  Models  DC-8  and  DC- 10  aircraft. 


SECTION  2 


SENSOR  AND  PLATFORM  PERFORMANCE  MODELS 

The  performance  models  of  the  gyro,  the  accelerometer,  and 
the  system  platform  motion  are  developed  in  this  section.  The  models 
contain  the  error  terms  whose  coefficients  are  to  be  identified  during 
the  centrifuge  tests.  The  error  source  terms  are  limited  to  those 
associated  with  an  acceleration  environment.  Error  terms  generated 
by  angular  rate  are  neglected,  since  it  is  assumed  that  the  angular 
rate  environment  is  limited  to  the  benign  motion  of  the  platform  with 
respect  to  inertial  space.  Instances  where  this  assumption  could  be 
invalid  will  be  mentioned  in  Section  3  with  the  understanding  that  the 
performance  models  of  this  section  must  be  expanded  to  include  those 
error  terms  proportional  to  angular  rate  that  contribute  significant 
error. 

2.  1  VECTOR  AND  MATRIX  NOTATION 

Since  both  vector  and  matrix  equations  will  be  used  throughout 
the  report,  a  standardized  notation  will  be  used  to  distinguish 
between  a  physical  vector  and  a  mathematical  vector.  A  physical  vec¬ 
tor  will  represent  some  physical  quantity  that  has  both  magnitude  and 
direction  associated  with  it;  however,  its  existence  in  space  will  be 
independent  of  any  coordinate  frame.  Since  physical  vectors  will  be 
used  in  the  application  of  the  theorem  of  Coriolis,  it  will  be  necessary 
to  indicate  the  reference  frame  in  which  a  vector  derivative  is  being 
taken.  The  notation  for  a  physical  vector  will  be  an  underlined 
variable.  Subscripts  will  indicate  the  relative  variables  for  which  the 


physical  quantity  is  measured,  and  superscripts  will  indicate  the 
reference  frame  in  which  a  vector  derivative  is  being  taken.  For 
example, 

o) ib  =  the  physical  angular  velocity  of  the  b  frame  relative 
to  the  i  frame 

•  J( 

R-e  =  the  physical  vector  velocity  of  the  e  frame  with  respect 
to  the  i  frame  as  viewed  from  the  reference  frame  k 
(i.e.  ,  the  derivative  is  taken  in  the  k  frame) 

A  mathematical  vector  is  associated  with  the  three  numbers  or  coordi¬ 
nates  that  are  the  components  of  the  physical  vector  relative  to  some 
coordinate  frame.  The  three  coordinates  representing  the  physical 
vector  form  a  3  X  1  column  matrix  that  will  be  referred  to  as  the 
mathematical  vector.  The  notation  for  a  mathematical  vector  will  be 
a  variable  that  is  not  underlined.  Subscripts  will  indicate  the  relative 
variables  for  which  the  physical  quantity  is  measured,  and  superscripts 
will  indicate  the  reference  frame  in  which  the  vector  is  coordinatized. 
For  example, 


w 


b 

ib 


JsJ 


Rk 

1C 


Ir  ,  r  ,  r  ) 
(  x’  y  zf 


l  J 

zJ 
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where  w.u  is  coordinatized  in  the  b  frame  and  R.  is  coordmatized  in 
lb  le 

the  k  frame.  The  braced  array  {  }  is  introduced  to  save  space  in  the 
written  text;  it  should  not  be  confused  with  a  row  matrix. 

Two  other  notations  will  be  used  throughout  the  text.  The  first 
is  a  direction  cosine  matrix,  C^,  which  transforms  a  column  matrix 


from  frame  b  to  frame  i. 

For 

example, 

i  b 

'Cli 

C  12 

C  1  3 

CbR  = 

C2i 

C22 

C23 

• c  3  i 

C32 

C  33, 

Lrz. 


where  Cj^  is  the  direction  cosine  between  the  jth  axis  in  the  i  frame 
and  the  kth  axis  in  the  b  frame.  The  second  notation  is  the  skew- 
symmetric,  cross-product  matrix.  It  is  the  matrix  form  of  the  vector 
cross  product  [i.e.,  it  represents  the  (u>ie  X)  portion  of  the  vector 
cross  product  X  II  ]  and  will  be  designated  as  .’('llows: 


w: 


ek  A 


le 


w  0 

z 


L-wy 


X 


where  the  first  superscript  c  designates  the  reference  frame  in  which 
the  matrix  elements  are  coordinatized,  and  the  second  superscript 
designates  by  the  letter  k  that  the  quantity  represented  is  by  definition 
the  3X3,  skew-symmetric,  cross-product  matrix. 
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2.2  GYRO  PERFORMANCE  MODEL 


Greenwood  [7]  shows  that,  from  Newton's  basic  law  of  rotational 
motion,  the  following  vector  equation  is  obtained: 

H  =  M  (2.1) 

where  H  is  the  vector  time  rate  of  change  of  the  angular  momentum  of 
a  particle  about  a  fixed  point,  which  is  equal  to  the  vector  moment 
of  the  total  external  force  applied  to  the  particle  about  the  same  fixed 
point.  Equation  (2.  1)  can  be  applied  to  a  gyro  to  describe  the  dynamic 
motion  of  the  gyro  element,  if  some  simplifying  assumptions  are  made 
concerning  the  gyro  element  [8].  The  gyro  element  consists  of  a  spin¬ 
ning  rotor,  a  drive  mechanism  for  the  rotor,  and  the  supporting  gim- 
bal  structure  as  shown  in  Figure  2.  1.  The  gyro  element  is  assumed 
to  have  the  following  simplifying  properties  that  are  valid  for  practical 
applications : 

(a)  The  rotor  spins  at  a  constant  speed  about  an  axis  of 
symmetry. 

(b)  The  center  of  mass  of  the  rotor  coincides  with  that  of  the 
gyro  element. 

(c)  The  gyro  rotor  and  gimbal  support  structure  are  rigid. 
Applying  Eq.  (2.1)  to  the  gyro  element  gives 

H*  =  M  (2.2) 

—  i.ge  — 
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where 


-  time  rate  of  change  of  angular  momentum  of  the  gyro 
element  ge,  with  respect  to  the  inertial  reference 
frame  i,  as  viewed  from  the  inertial  frame 


M  torque  applied  about  the  center  of  mass  of  the  gyro  element 


Applying  the  first  equation  of  Coriolis  [Reference  Eq.  (A.  3)  in  Appen 
dix  A]  to  the  left-hand  side  of  Eq.  (2. 2)  gives 


h!  =  u*c  +  w.  XH. 

—  i,ge  —  i.gc  — i,  ge  —  i,gc 


(2.3) 


The  angular  momentum  vector  of  the  gyro  element,  II  .  ,  is  equal  to 

the  vector  sum  of  the  spin  angular  momentum  vector  of  the  rotor,  Hg, 
and  the  nonspin  angular  momentum  of  the  gyro  element,  Hns*  Substi¬ 
tuting  this  vector  sum  into  the  right-hand  side  of  Eq .  (2.  3)  and  using 
the  equality  of  Eq.  (2.2)  gives 


M  =  Hge  +  Hge  +  w.  X  H 
—  — s  — ns  — i,ge  — s 


U)  . 


■i>ge 


H 

—  ns 


(2.4) 


•  {IQ 

The  rotor  speed  is  assumed  constant,  implying  that  I_l£  =  0;  there¬ 
fore,  Eq.  (2.4)  reduces  to 


M  =  H8e  +  w.  X  H  +  w.  X  H  (2.5) 

—  — ns  —  i ,  go  — s  — i,gc  — ns 


Equation  (2.  5)  is  the  basic  law  of  motion  of  t ho  gyroscopic  element. 

•  fT  (' 

The  Hh  term  is  the  source  of  the  characteristic  dynamics  or 
—  ns  ' 
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transient  response  of  the  gyro  element.  The  vector  cross-product 
terms  contribute  to  the  gyro's  steady-state  behavior. 

Since  most  Inertial  Navigation  Systems  employ  single -degree- 
of-freedom  integrating  (SDFI)  gyros  [9],  an  equation  describing  the 
motion  or  precession  of  the  gyro  element  with  respect  to  a  gyro  case 
axis  frame  will  be  developed  for  a  SDFI  gyro.  Expressing  Eq.  (2.  5) 
in  a  matrix  form  such  that  the  applied  torque  is  coordinatized  in  the 
case  or  c  frame,  as  shown  in  Figure  2.  1,  gives  the  following  matrix 
equation  for  the  gyro  element  motion: 

Mc  =  Cc  Hge  +  Wck  Cc  Hge  +  W?k  Cc  Hgc  (2.6) 

ge  ns  ic  ge  s  ic  gc  ns 


where 


Q 

C  =  the  gyro  element  to  case  transformation  matrix 
gc  By 

Hge  =  time  rate  of  change  of  nonspin  angular  momentum  matrix 
coordinatized  in  the  moving  gyro  element  frame 


W.  =  skew-symmetric,  cross-product  matrix  of  the  angular 
velocity  of  the  case  frame  relative  to  inertial  space, 
coordinatized  in  the  case  reference  frame 

Hf,  Hg®  -  are  the  spin  and  nonspin  angular  momentum  matrices, 
respectively,  both  coordinatized  in  the  ge  frame 


Since  the  gyro  element  motion  of  a  SDFI  gyro  is  constrained  to  pre¬ 
cession  about  the  output  axis,  an  expression  for  the  output  axis  torque, 
Mqa»  will  be  obtained  from  Eq.  (2.6).  The  gyro  precession  angle 
about  the  output  axis  (shown  as  A  in  Figure  2.1)  is  maintained  well 
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below  five  arc -minutes  by  the  platform  stabilization  loop, 
a  small-angle  transformation  can  be  assumed  for  the  gyro 
case  transformation. 

0  A  " 

g 

1  0 
0  1 

«d 

Define 

mC  {Mr  moa’  msra} 

“ic  |“l'  “OA1  “sRa} 


Therefore,  by  the  definition  of  the  cross-product  matrix 


w: 


ck 


ic 


ui 


SRA 


JOA 


-  w 


SRA 
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u> 


-w 


OA 

I 

0 


Now 


o.  h} 

Wi.ge  {“V  “y- 

"ns  =  {*  *V  ry  V  !z  “J 


Therefore 
element  to 


(2.7) 


'2.8) 


(2.9) 


(2.  10) 
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where 


I 


I 

z 


are  the  principal  moments  of  inertia  about  the  ge 
axes 


An  expression  for  obtaining  the  angular  velocities  of  the  ge  frame  is 


cop 

1.  ge 


CgG  coc 

C  1C 


+  CO 


ge 

c,  ge 


(2.11) 


where 


co?6 

it 

o 

>• 

o 

c.  ge 

l  g  > 

r  ~\  - 1  r 

cRe  4 

cc  -  \c 

c 

L  gej  L 

(Reference  Figure  2.1) 

-|T 


Q 

C  is  a  direction-cosine  matrix,  implying  that  it  is  an  orthogonal 
gc 

matrix  (7 ];  therefore,  its  inverse  is  equal  to  its  transpose.  Substitut¬ 
ing  the  appropriate  matrices  from  Eqs .  (2.7),  (2.8),  and  (2.  10)  into 
Eq.  (2.  11)  gives  the  following  set  of  equations  for  the  ge  frame  angu¬ 
lar  velocities: 


co 

X 


CO 


y 


CO 

z 


co  -  A  cocr>  . 
I  g  SRA 


c 0„.  +  A 
OA  g 


CO,,.,  *  *  A  CO  T 

SRA  g  I 


(2. 12) 
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Therefore,  from  Eq.  (2.  10), 


where 


M  -  torque  applied  by  the  gyro  torque  generator 

=  viscous  damping  torque  coefficient 

(u)M  uncertainty  torque  caused  by  internal  gyro  error 
sources 


Substituting  Eq.  (2.  16)  into  Eq.  (2.  15)  and  rearranging  the  terms  gives 
the  dynamic  equation  of  motion  for  a  SDFI  gyro. 


,  H  H 

V  .  •  s  tg  (u)M  s  .  • 

t  A  +  A  =  -pr-  w  T  +  +  r - ~F~  ucd  a  A  -  t  w 

g  g  g  cd  1  cd  Cd  Cd  SRA  g  g  OA 


(2. 17) 


(I  -  I  ) 

'  v  v 


wl  “SRA  +  (wI  ‘  WSRA)  (IZ  "  Ix) 


Except  for  the  first  three  terms,  all  the  remaining  terms  on  the 
right-hand  side  of  Eq.  (2.  17)  are  undesirable  cross -coupling  terms. 
The  significance  of  these  terms  should  be  evaluated  using  the  specific 
design  characteristics  of  the  SDFI  gyro  in  conjunction  with  the  expected 
values  of  the  external  parameters  generated  by  the  operating  environ¬ 
ment.  Gyro  operation  in  a  platform  mode  involves  the  rotational  sta¬ 
bilization  of  the  gimbaled  platform  upon  which  the  gyros  are  mounted. 

If  the  platform  is  stabilized  in  the  inertial  frame  of  reference,  then  the 
last  four  terms  o;  the  right-hand  side  of  Eq .  (2.  17)  can  be  neglected, 
since  an  inertial  frame  mechanization  subjects  the  gyros  to  the  most 
benign  rotational  environment  possible.  In  addition,  the  time  constant, 


of  a  platform  type  gyro  is  made  very  small  by  decreasing  the  output 
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axis  moment  of  inertia  I  and  increasing  the  viscous  damping 
coefficient  .  Making  the  time  constant  small  minimizes  the  effects 
of  the  transient  response  terms  (r  A  and  t  £>._.)  on  the  loop  per- 

y  g  g  g  oa  K  F 

formance.  Those  terms  involving  the  product  of  the  output  precession 

angle  A  are  further  reduced,  since  the  high-gain  platform  stabiliza- 
8 

tion  loop  maintains  A  essentially  at  null  (less  than  one  arc-minute). 

S 

As  discussed  in  Section  1.  3,  the  platform  calibration  program 
employs  a  dynamic  test  procedure  in  which  the  gyros  are  command 
torqued  to  drive  the  platform  through  a  prespecified  rotational  pro¬ 
file.  This  implies  that  an  inertially  rotating  reference  frame  is  being 
instrumented  during  the  test  program;  therefore,  the  effects  due  to 
the  cross -coupling  terms  must  be  evaluated  to  determine  if  any  of  the 
last  four  terms  should  be  included  in  the  final  version  of  the  gyro  per¬ 
formance  model.  Rewriting  Eq.  (2.  17)  in  an  alternate  form  yields: 


Cd  ..  cd 

TT  Tg  Ag  +  wO  =  UI  +  WCML  f  (u)wD  ■  w  SR  A  Ag  '  lT  Tg  “OA 


(I  -  I  )  A  .  - 

1  H"  WI  w  SR  A  +  H^"  (wI  ■  uSRa’  (Iz  ■  Ix) 
s  s 


(2.18) 


where 


W 


d  • 


O  H  8 


A  =  output  angular  rate  of  the  gyro 


Wj  =  applied  rate  about  the  gyro  input  axis 


M. 

_l£ 


CMD  "  ~ll  commanded  angular  rate 
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(U)«D 


(u)M 

H3 


error  drift  generated  by  internal  gyro  error 
sources 


A  comparison  of  the  magnitude  of  the  cross -coupling  terms  versus  the 
first  three  terms  on  the  right-hand  side  of  Eq.  (2.  18)  is  given  below. 
The  given  parameters  are  based  on  the  design  characteristics  of  the 
Carousel  VB  Inertial  Measurement  Unit  SDFI  gyros  [10],  and  the 
angular  rate  and  acceleration  values  are  from  a  computer  simulation 
of  the  platform  rotational  profile  that  was  generated  in  support  of  the 
data  reduction  evaluation  described  in  Section  1.4.  Given: 


A  =  1  arc-minute 
g 

=  62,500  gm-cm^/sec 

Hg  =  1  X  10^  gm-cm^/sec 

t  =2  milliseconds 
g 


-4 

Uj  =  5.4  X  10  rad /sec 


w  sra  =  ^  X  10  rad /sec 


*  =  3.2  X  10  ^  rad/scc 


OA 


I  -  I  =10  gm-cm 
Z  X 


2 


The  magnitudes  of  the  terms  in  Eq.  (2.  18)  are: 

-4 

WI  +  ^CMD  +  ^u)“)  |)  =  6.0  X  10  rad/scc 

gjcd  .  A  =  14.5  X  JO'8  rad/sec 
SRA  g 
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rad / sec 


TT  r„sOA  3  4-°  *  10‘“ 

S  ” 


(I  -  I  ) 

Z  X 

H  “i  WSR  A 

s 


2.7X10  ^  rad/sec 


Jj*  (wj-  WgRA)  (Iz  -  Ix)  =  1.2  X  10'15  rad/sec 


15 


A  comparison  shows  that  the  cross -coupling  terms  can  be  neglected. 
Since  is  small,  the  transient  response  can  also  be  neglected;  there¬ 
fore,  Ecj.  (2.  18)  reduces  to  the  following  steady-state  equation: 


"O 


CMD  +  (u)  WD 


(2.  19) 


As  was  shown  in  Eq.  (1.  1)  of  Chapter  1  ,  the  error  drift  term,  (u)u>j-j, 
is  equal  to  the  sum  of  the  drift-producing  error  sources  internal  to 
the  gyro.  Therefore,  from  Eq.  (1.  1),  the  gyro  performance  model 
equation  is 


wO  (DF  +  DI  aI  f  Do  aO  +  DS  aS  +  DII  aI  +  Doo  aO  +  DSS  aS 


+  DIO  ai  ao  +  DIS  aI  aS  +  DOS  aO  aSJ  +  WI  +  UCMD 


(2.20) 


As  previously  mentioned,  the  gyro  error  sources  considered  are 
limited  to  those  normally  found  when  subjecting  the  gyro  to  an  acceler¬ 
ation  environment.  The  error  term  expansion  in  Eq.  (2.20)  contains 
those  terms  that  have  been  found,  by  numerous  tests  conducted  at  the 
Central  Inertial  Guidance  Test  Facility,  to  be  the  predominant  sources 
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of  error.  Wriglcy  [8|,  Taylor  [11],  and  Lorenzim  [12]  have  excellent 
descriptions  of  the  physical  properties  in  the  gyro  that  generate  the 
error  drifts . 

2.  3  ACCELEROMETER  PERFORMANCE  MODEL 

The  accelerometer  considered  in  this  study  is  a  force-rebalance 
pendulous  type  device,  which  can  be  represented  in  the  simplified 
form  of  Figure  2.2.  Based  on  the  behavior  of  a  simple  pendulum 
under  the  influence  of  pivot  acceleration,  the  acceleration  force  acting 
on  the  center  of  gravity  of  the  pendulum  will  cause  the  pendulum  to 
accelerate  in  the  direction  of  the  force  and,  in  addition,  cause  a 
moment  to  be  applied  about  the  pivot,  which  impaits  an  angular  accel¬ 
eration  to  the  pendulum.  The  rotation  of  the  pendulum  about  the  pivot 
is  represented  by  the  angle  about  the  output  axis  A^  in  Figure  2.2. 

The  force -rebalance  feature  of  the  ac  celerometer  is  normally  feed¬ 
back  current  flowing  through  a  forcer  coil,  which  is  mounted  on  the 
pendulous  element,  reacting  with  a  permanent  magnet  to  drive  the 
pendulum  back  to  its  null  position.  With  an  acceleration  applied  to 
the  input  axis,  the  moment  about  the  output  axis,  M^^,  is  as  follows: 

.FI  m  aT  1  m  aT  1  cos  An  (2.21) 

OA  ay  I  y  I  O  '  ' 


where 


F  =  acceleration  force 
a 

aj  =  acceleration  applied  to  the  input  axis 


2 


1  length  of  the  pendulum  of  mass  m 


1  l  cos  A~  ~  effective  length  of  the  pendulum  with  respect 

v  0  to  F 


Based  on  the  design  c  haracteristics  of  a  force-rebalance  accelerometer, 


moa  is 


also  represented  by: 


M 


OA 


-  Ip  A q 


f  C 


A 


O 


t-  k  A, 


u)M 


(2. 22) 


where 


Ip  moment  of  inertia  of  the  pendulum  about  the  pivot  or 
output  axis 

C(j  =  viscous  damping  coefficient 

k  -  spring  or  elastance  coefficient  of  the  pivot  hinge 

(u)M  =  uncertainty  torque  due  to  internal  error  sources  of  the 
accelerometer 


Because  of  the  high-gain  rebalance  loop,  Aq  is  maintained  essentially 
at  null.  Therefore,  using  a  small  angle  approximation  for  Aq  (i.e.  , 
cos  Aq  «  1)  and  equating  Eqs.  (2.21)  and  (2.22)  gives 


0 


+  A 


O 


mi  4 
k  I  k 


(2.23) 


Comparing  the  left-hand  side  of  Eq.  (2.23)  with  the  standard  form  of 
a  second-order  transient  solution 
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shows  that 


u  n 

n 


WM  ^  =  \rk  /Ip  undamped  natural  frequency 


2  ,vk  —  =  damping  ratio 


and  therefore  the  accelerometer  time  constant,  t  ,  is 

a 


-  _!_  1  Ip 

a  £  cj  C  , 

^  n  d 


2  2 

Typical  values  are:  Ip  -  7.06  gm-cm  and  =  47,000  grn-cm  / sec, 
which  gives  a  value  of  0.  3  milliseconds  for  t  .  Neglecting  the  tran- 

cl 

sient  response  gives  the  following  steady-state  equation: 


aIND  aJ  1  <u,a 


(2.24) 


where 


lIND  ~  rnT  =  indicated  output  of  the  accelerometer 


(u)a  =  ' — -s—  uncertainty  in  acceleration  due  to  internal  error 


sources 


3  0 


Reference  Fq.  (1.2);  the  uncertainty  term,  (u)a,  is  equal  to  the  sum 
of  the  accelerat  an  error  sources: 


2  3 

(u)a  Kq  +  (u)Kj  a^  +  a^  +  a^  +  Kjp  a^  ap  (2.25) 


Substituting  Eq  .  (2.25)  into  Eq.  (2.24)  gives  the  accelerometer  per¬ 
formance  model  equation: 


1ND 


f  K,  aT  t 


'O 


1  I 


K2af 


K3  aj  + 


KIP  aI  a  P 


(2.26) 


where 


Kj  (t  +  (u)Kj) 

(u)Kj  uncertainly  in  the  accelerometer  scale  factor 

As  was  the  case  with  the  gyro  performance  model,  the  accelerometer 
error  sources  considered  are  limited  to  those  normally  found  when 
the  accelerometer  is  subjected  to  an  acceleration  environment.  The 
cross-ax. s  term  K^p  aT  ap  is  to  account  for  the  case  where  an  accel¬ 
eration  applied  along  the  pendulous  axis  causes  an  additional  moment 
about  the  pivot;  the  additional  moment  occurs  because  of  the  moment- 
arm  generated  by  the  offset  of  the  pendulum,  which  was  caused  by  the 
simultaneous  application  of  a^  along  the  input  axis.  Obviously,  the 
cross-axis  contribution  is  small  since  the  offset  of  t:h«  pendulum  is 
the  angle  ,  which  is  maintained  very  small  to  prevent  the  coupling 
effect. 
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2 .  4  P  LA  T  FO  R  M  PK  R  FO  RMANC  }•:  MO  DP!  LS 


Rased  on  the  discussion  in  Section  1.  3,  one  may  derive  two 
requirements  for  platform  performance  information.  The  first 
requirement  is  to  obtain  an  expression  of  the  platform  rate  with 
respect  to  some  laboratory  reference  frame,  in  order  to  establish 
the  system  dynamic  equations,  which  track  the  platform  motion.  The 
second  requirement  is  to  obtain  an  expression  for  the  output  of  the 
platform  accelerometers,  which  formulates  the  measurement  dynam¬ 
ics  and  provides  the  basis  for  the  measurement  sequence. 

The  platform  provides  the  stabilization  or  base  motion  isolation 
function,  implying  that  a  vector  representation  of  the  platform  rate  is 
essentially  equal  in  magnitude  but  opposite  in  direction  to  the  gyro 
output  angular  rate,  uJq. 


— rp  '  — O  +  iL^SERVO 


(2. 27) 


where 


w  angular  rate  of  the  platform  frame  p  with  respect  to  the 
rP  platform  base  or  mounting  fixture  frame  r,  which  is  the 
selected  laboratory  reference  frame 

6_uj_S£rvo  uncertainty  in  platform  rate  due  to  the  stabiliza¬ 
tion  loop  servo  error 


From  Eq.  (2.  19),  Eq.  (2.27)  is  also  equal  to 


-rp  =  "  -I  "  —  CMD  *  +  —SERVO 


(2.28) 
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A  matrix  equation  of  the  platform  rate  coorriinatized  in  the  platform 
reference  frame  requires  a  clear  understanding  of  the  vectors  given 
on  the  right-hand  side  of  Eq.  (2.28).  Uj  is  the  angular  rate  sensed  by 
the  gyro  about  its  input  axis.  The  motion  sensed  by  the  gyro  is  identi¬ 
cal  to  the  motion  of  the  inner  gimbal  platform  where  the  gyro  is 
mounted.  However,  the  motion  of  the  inner  gimbal  is  identical  to  the 
motion  of  the  system  platform  base  or  mounting  fixture ,  since  the  outer 
gimbals  of  the  system  platform  transmit  the  base  motion  directly  to 
the  inner  gimbal.  Therefore,  the  angular  rate  sensed  by  the  gyro  is 
identical  to  the  angular  rate  of  the  base  with  respect  to  inertial  space, 
oj.^.  So,  coordinating  Wj  in  the  base  frame  r  gives  the  following 
matrix  equation  for  the  applied  rate  about  the  gyro  input  axis. 

wrr  (2.29) 

The  commanded  angular  r.ate,  and  the  error  drift  rate,  (u)u.'j-j, 

are  both  generated  by  sources  internal  to  the  gyro.  They  represent 
motion  of  the  gyro  element  with  respect  to  the  gyro  case  as  generated 
by  command  and  uncertainty  torquing.  The  gyro  element  axes,  shown 
in  Figure  2.  1,  will  lie  defined  as  the  gyro  sensor  axis  frame  s.  The 
gyro  case  input  axis  will  be  considered  identical  to  the  direction  of  the 
inner  gimbal  platform  axis  for  that  gyro.  In  other  words,  the  X,  Y, 
and  Z  gyro  case  input  axes  establish  the  direction  of  the  x,  y,  and  z 
inner  gimbal  platform  axes  which  will  be  known  as  the  p  frame. 
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rhorcfore,  the  matrix  equations  for 
error  drift  rate,  both  coordinated 


the  command  angular  rate  and  the 
in  the  p  frame,  are: 


GJ 


CMD 


r-H  s 
s  ^CMD 


w 


D 


cp  s 


s  WD 


(2.  30) 


where 


w  CMD  ^matrix  o{  commanded  angular  rates  in  the  sensor 


WD  -  a  matrix  of  error  drift  rates  in  the  sensor  frame 

c"  matrix  from  thc — *•■>»  * 


Combining  Eqs.  (2.28 )  through  (2.30)  gives 
the  platform  rate  in  the  platform  frame  as 


the  matrix  equation  for 
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rP 
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yp 
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Zp  J 
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CMD 


-  CP  r 


r  tr  SERVO 


(2.  31) 


The  first  matrix  expression  on  the  right-hand  side  of  Eq .  (2.31) 
actually  represents  the  combined  contribution  of  the  X,  Y.  and  Z 
Ryros.  Therefore.  Eq.  (2.  31)  can  be  rewritten  as 
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(2.  32) 


CPGj(j  X,  Y,  Z)  are  the  coordinate  transformations  from  the  gyro 
sensor  axes  to  the  platform  frame.  These  transformations  will  be 
d<  fined  in  Section  3.  CP  is  the'  transformation  from  the  platform  base 
to  the  inner  platform  p  frame  and  uill  be  defined  in  Section  4.  Equa¬ 
tion  (2.20)  represents  the  performance  model  for  all  three  gyros; 
therefore,  Eq.  (2.  32)  <  an  be  expanded  to  incorporate  all  the  terms 
from  Eq.  (2  20)  for  each  gyro.  The  final  form  of  the  platform  rate 
performance  model  matrix  equation  is: 
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(2. 33) 
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who  ro 


a 


U’ 


X.  Y,  Z)  -  aro  Lho  applied  accelerations  along 
the  gyro  input,  output,  and  spin 
axes  respectively  (these  will  be 
defined  In  Section  3) 


TSF  (j 
J 


X,  Y,  Z)  -  are  the  internal  gyro  torquer  scale  factors 


yj  -x,  Y,  Z) 


are  the  gyro  command  to*que  values 


Therefore, 


TSF.  X  t 
J  RJ 


=  (*)£jy{]3  jth  commanded  angular  rate 

j 


To  simplify  the  measurement  equation,  the  indicated  acceleration  of 
the  inner  gimbal  platform  will  be  defined  in  the  accelerometer  sensor 
frames.  Applying  the  accelerometer  performance  model  equation, 

Eq.  (2.26),  to  all  three  platform  accelerometers,  the  platform  indi¬ 
cated  acceleration  performance  model  is: 
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where 


(2.34) 

Cont. 


aIAj'  aPj^  ^ "  are  the  applied  accelerations  along  the 

accelerometer  input  and  pendulous 
axes  respectively  (these  will  be  defined 
in  Section  3) 


We  now  have  all  the  performance  models  necessary  to  define  the  state 
and  measurement  dynamics  of  the  calibration  problem.  In  the  next 

section,  the  applied  sensor  acceleration  with  respect  to  inertial  space 
will  be  developed. 
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SECTION  3 


APPLIED  ACCELERATION 

The  acceleration  that  is  applied  to  the  inertial  sensor  axis 
frames  is  developed  in  this  section.  Since  the  major  portion  of  the 
applied  acceleration  is  due  to  the  kinematic  motion  of  the  centrifuge, 
a  description  of  the  centrifuge  and  the  various  coordinate  transforma¬ 
tions  required  to  describe  the  motion  will  be  defined. 

3.  1  DESCRIPTION  OF  THE  260-INCH  CENTRIFUGE 

The  260-inch  radius  precision  centrifuge,  shown  in  the  cutaway 
view  of  Figure  1.  1,  is  enclosed  in  a  building  90  feet  in  diameter  [3]. 
The  main  arm  is  a  steel  weldment  formed  by  two  double-edge  beams 
tied  together  by  trusses  to  form  a  single  beam.  The  arm  is  totally 
enclosed  in  a  cylindrically  shaped  aerodynamic  shroud  (referred  to  as 
the  dynamic  cylinder  in  Figure  1.1),  50  feet  in  diameter  and  11  feet 
high,  that  rotates  with  the  arm.  The  aerodynamic  shroud  is  enclosed 
in  a  smooth-walled,  stationary  cylinder  to  reduce  drag.  Chilled-water 
cooling  plates  located  at  the  top  and  bottom  of  the  stationary  wall  re¬ 
duce  the  temperature  rise  between  the  shroud  and  the  stationary  wall 
due  to  aerodynamic  heating.  The  main  spindle,  which  is  4  feet  in 
diameter,  is  supported  by  upper  and  lower  hydrostatic  oil  bearings. 

The  lower  bearing  supports  the  entire  weight  of  the  rotating  cylinder, 
consisting  of  the  main  arm  structure  and  shroud,  which  is  approxi¬ 
mately  45  tons.  Mounted  just  below  the  upper  bearing  are  two  drive 
motors:  a  400-horsepower  induction  motor  to  accelerate  the  arm 
and  a  17  5-horsepower  synchronous  motor  for  constant  rate  drive. 


The  speed  of  the  main  arm  is  continuously  variable  to  attain  accelera¬ 
tion  levels  from  0.25  to  100  g's  by  means  of  a  frequency  divider  with 
a  vernier  control  and  a  precision  frequency  source.  The  frequency 
divider  provides  the  reference  signal  to  stabilize  the  synchronous 
motor  after  the  induction  motor  has  driven  the  main  arm  up  to  the 
selected  speed.  Speed  variations  of  the  synchronous  drive  system  are 
further  reduced  by  damping  in  the  centrifuge  feedback  stabilization 
loop.  Angular  velocity  errors,  averaged  over  a  50-second  time 
period,  have  been  measured  at  less  than  3  micro-radians  per  second. 

The  centrifuge  arm  is  statically  balanced  at  rest  by  counter¬ 
weights  placed  on  the  opposite  end  of  the  arm  from  the  counter-rotating 
platform.  Dynamic  balance  is  achieved  during  operation  by  motor- 
driven  weights  located  on  the  arm  structure.  The  motor-driven  weight 
locations  are  changed  until  the  output  of  proximity  detectors,  located 
in  the  upper  and  lower  bearings,  are  equalized.  Equalization  of  the 
detector  outputs  implies  that  a  dynamic  balance  has  been  achieved, 
since  the  main  spindle  rotational  axis  will  be  centered  in  the  hydro¬ 
static  bearing  housings,  which  were  aligned  to  the  local  vertical  during 
installation.  The  main  spindle  verticality  is  adjustable  during  the 
static  balance  procedure  to  1  arc-second  using  the  output  of  the  prox¬ 
imity  detectors;  changes  in  verticality  during  operation  are  measurable 
to  0.2  arc-second  using  the  detectors. 

The  centrifuge  radius  is  also  measured  statically  and  dynam¬ 
ically.  The  static  radius  is  measured  to  an  accuracy  of  2  pans  per 
million  of  the  260-inch  radius  by  a  micrometer  consisting  of  three 
calibrated  Invar  rods  and  a  precision  stepper  motor.  The  motor 
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drives  the  rods  to  abut  the  main  and  CRP  spindles,  thereby  measuring 
the  desired  distance  between  the  center  of  the  centrifuge  and  the  center 
of  the  CRP.  The  change  in  radius  or  stretch  of  the  arm  due  to 
g-loading  and  aerodynamic  heating  is  measured  to  an  accuracy  of 
1  part  per  million  by  determining  the  capacitance  between  two  plates 
that  are  part  of  a  capacitance  bridge  network.  One  plate  is  attached 
to  a  probe  that  is  fixed  to  the  CRP  spindle,  which  rotates  with  the  arm; 
the  other  is  a  movable  plate  that  is  attached  to  the  stationary  wall. 
During  centrifuge  operation,  the  stationary  wall  plate  is  moved  out¬ 
ward  tc  bring  it  in  close  proximity  with  the  plate  attached  to  the  rotat¬ 
ing  arm;  the  value  of  capacitance  between  the  plates  and  any  change  in 
capacitance  are  proportional  to  the  distance  and  change  in  distance 
between  the  plates,  which  in  turn  provide  the  dynamic  radius  mea¬ 
surement.  The  stretch  at  both  the  top  and  bottom  of  the  centrifuge 
arm  is  measured  to  detect  arm  droop  or  rise  caused  by  unequal 
g-loading  or  heating  of  the  upper  and  lower  arm  structure.  There  are 
three  pairs  of  dynamic  radius -measuring  stations,  equally  spaced 
around  the  stationary  wall,  to  separate  a  change  in  radius  from  a  dis¬ 
placement  of  the  main  spindle. 

The  CRP  is  a  cylinder,  50  inches  in  diameter  and  50  inches  high, 
that  will  support  a  30,  000-g-lb  load  (i.  e. ,  a  300-lb  load  at  100  g's). 

The  CRP  spindle  is  also  supported  by  hydrostatic  oil  bearings;  there¬ 
fore,  procedures  similar  to  those  used  for  the  main  spindle  permit  the 
CRP  spindle  to  be  adjusted  within  5  arc-seconds  o'f  ’-ertical  with  an 
accuracy  of  0.2  arc-second  when  the  centrifuge  is  at  rest,  and  changes 
in  verticality  are  measurable  to  2  arc-seconds  during  operation.  The 
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CRP  drive  system  is  a  phase-lock  position  servo  hat  utilizes  an  error 
signal  to  maintain  synchronous  counter-rotation.  The  error  signal  is 
obtained  either  from  a  pair  of  identical  16-pole  resolvers,  one  mounted 
on  the  main  spindle  and  the  other  on  the  CRP  spindle,  or  from  a  pair 
of  720-tooth  gears  similarly  mounted.  The  error  signal  is  amplified 
to  drive  two  induction  motors  on  the  CRP.  Power  and  instrumentation 
signals  are  transferred  to  and  from  the  main  centrifuge  arm  and  CRP 
via  silver  brush  and  slip  ring  assemblies  mounted  on  the  spindles. 

A  simplified  example  of  the  acceleration  applied  to  the  system 
platform  axes  during  centrifuge  operation  in  the  counter-rotating  mode 
is  shown  in  Figure  3.  1.  The  simplifying  assumptions  of  this  example 
are  as  follows: 

(a)  Perfect  counter-rotation  of  the  CRP  is  assumed. 

(b)  The  system  platform  error  drift  and  gyro  command  rate 
are  zero. 

(c)  The  system  stabilization  function  is  assumed  to  be  perfect. 

(d)  Earth  rate  is  assumed  to  be  zero. 

(e)  The  acceleration  applied  to  the  platform  axes  is  limited  to 
the  centripetal  acceleration  of  the  centrifuge. 

The  example' shows  that  the  acceleration  along  the  platform  axes  in  the 

rotational  plane  is  a  sinusoid  with  a  zero-to-peak  magnitude  equal  to 

the  centripetal  acceleration.  The  angular  rate  range  of  the  centrifuge 

is  0.  609  rad/sec  at  0.  25  g's  to  12.  176  rad/sec  at  100  g's,  based  on  a 

2 

radius  of  260  inches  and  a  local-gravity  magnitude  of  32,  1238  ft/sec  . 
The  frequency  range  associated  with  the  preceding  angular  rates  is 
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LEGEND: 


0.097  to  1.938  Hz;  therefore,  as  previously  mentioned,  the  accelera¬ 
tion  applied  to  the  system  is  a  low  frequency  sinusoid. 


3.2  COORDINATE  TRANSFORMATIONS 

The  basic  coordinate  frames  represented  in  the  major  trans¬ 
formations  linking  inertial  space  to  the  sensor  axes  are: 

I  -  Inertial  frame 

E  -  Earth  frame 

C  -  Centrifuge  main  arm  frame 

R  -  Centrifuge  counter-rotating  platform  frame 

P  -  System  inner  gimbal  platform  frame 

S  -  Sensor  frame 

All  coordinate  frames  will  be  considered  right-hand  orthogonal  axis 
sets. 


3.2.1  Inertial  -  Earth  Transformation 

The  inertial  frame  is  defined  at  the  center  of  the  earth 

and  is  nonrotating  with  respect  to  the  "fixed  stars".  The  and  Y. 

axes  lie  in  the  equatorial  plane  and  the  Z.  axis  is  coincident  with  the 

earth's  angular  velocity  vector,  _u.c>  As  illustrated  in  Figure  3.2, 

the  X.  axis  intersects  the  local  meridian  at  the  initial  calibration  time 
i 

(i.  e.  ,  when  t  =  0).  The  earth  frame,  reference  Figure  3.2,  is  a 
tangent  frame  that  is  fixed  on  the  rotating  earth,  with  its  origin  at  the 
intersection  of  the  geographic  latitude  L,  and  the  local  meridian  at  a 
point  on  the  earth's  surface  corresponding  to  the  location  of  the  center 
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Figure  3.2.  Inertial  and  Earth  Coordinate  Frame 


of  the  centrifuge  main  spindle.  The  axes  are  aligned  with  the  cast, 
north,  and  up  directions.  The  up  axis,  Z  ,  is  defined  to  be  coincident 
with  the  local  vertical.  Since  the  best  physical  measure  of  the  local 
vertical  is  the  local -gravity  vector  £,  the  local  vertical  is  considered 
coincident  with  the  local -gravity  vector  and  any  deviations  of  g  ciused 
by  mass  anomalies  are  assumed  negligible  [13],  The  north  axis 
is  in  the  direction  of  the  projection  of  the  earth's  inertial  angular 
velocity  vector  into  the  local  horizontal  plane.  The  east  axis 
completes  the  right-hand  orthogonal  set  and  also  lies  in  the  local 
horizontal  plane. 

From  Figure  3.2,  the  inertial -ea rth  coordinate  trans¬ 
formation  matrix  is 


ce  = 

1 


■  sin  L  0  cos  L 


cos  L  0  sin  L 


(3.  1) 


The  matrix  representation  of  the  rotation  of  the  earth  frame  w’ith  re¬ 
spect  to  the  inertial  frame,  coordinatized  in  the  earth's  axes,  is 


c 

u>.  =  f  0,  w  .  cos  L,  u.  sin  L  r 

le  t  ie  ic  1 


(3.2) 


where 


w.  7.  2d  2116x10  rad/ sec  =  the  scalar  value  of  earth  rate 
ie 


L  -  32°  53'  26.614"  =  geographic  latitude  of  the  centrifuge 
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Defining: 


WES  =  oo  .e  sin  L  =  3.95990552  X  10~5  rad/sec 

WEC  =  u.  cos  L  =  6.  1232531  X  10"5  rad/sec 
le 

The  cross-product  matrix  form  is 

WeV 
le 

The  scalar  distance  between  the  coordinate  frames,  R.  ,  remains 

le 

constant  and  is  equal  to  the  earth's  radius. 

Before  describing  the  next  transformation,  it  should  be 
noted  from  Figure  3.  2  that  the  local -gravity  vector  has  been  shown  as 
acting  outward  from  the  earth,  rather  than  inward.  This  convention  is 
used  in  the  guidance  test  field  because  of  the  concept  of  acceleration 
as  measured  by  an  accelerometer  whose  case  is  fixed  on  the  platform, 
and  the  platform  is  mounted  on  the  test  device.  Consider  the  simple 
linear  accelerometer,  at  rest  on  a  sphencal  homogeneous  nonrotating 
earth,  illustrated  in  Figure  3.3.  The  accelerometer  input  axis  is 
parallel  to  the  earth  radius  vector  R.^,  and  a  positive  output  accelera¬ 
tion  corresponds  to  a  positive  displacement  of  the  accelerometer's 
seismic  mass.  Since  the  case  of  the  accelerometer  is  fixed,  the  mass 

attraction  force  of  the  earth  F  acts  on  the  seismic  mass  of  the 

—  e 

accelerometer.  The  seismic  mass  is  displaced  until  the  restoring 
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force  of  the  spring  equals  the  mass  attraction  force.  Because  of  the 
positive  mass  displacement,  the  accelerometer  will  indicate  a  positive 
acceleration  output  of  (Reference  Figure  3.  3): 


G  M  F 

-  _  ,  _  4  _e e  _  .  _e 

-IND  “  -e  "  -R.  ~  T  ~  ~R.  m 
le  R.  le 

le 


(3.4) 


The  second  component  of  the  local -gravity  vector  is  due 

to  the  centripetal  acceleration  generated  by  earth's  rotation, 

to  .  X  (w  .  X  R  .  ),  illustrated  in  Figure  3. 4.  The  specific  force  f  , 

—  ic  —  ic  —  le  -c 

acting  on  a  unit  seismic  mass,  is  equal  in  magnitude,  but  opposite  in 
direction,  to  the  centripetal  acceleration.  The  total  force  acting  on 
the  seismic  element  is  the  vector  addition  Fe  and  f  g,  causing  a 
positive  displacement,  which,  in  turn,  is  interpreted  by  the  acceler¬ 
ometer  as  a  positive  acceleration.  Therefore,  by  convention,  the 
local-gravity  vector  is  defined  as  acting  outward  from  the  earth  and  is 
equal  to  the  following  vector  equation: 


gj.  X  w  .  XR.  )  +  1  „ 

—  ic  —  le  — le  — R. 

le 


G  M 
e  e 

R.  2 

le 


(3.5) 


3.2.2  Earth -Centri fuge  Main  Arm  Transformation 

A  number  of  intermediate  transformations  are  required 
to  go  from  the  earth  tangent  axes  to  the  centrifuge  main  arm  axes  [14]. 
The  first  intermediate  transformation  shown  in  Figure  3.5  accounts 
for  any  variation  of  the  centrifuge  main  spindle  from  the  local  vertical. 
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igure  3.  5.  Earth  -  Centrifuge  Main  Arm  Coordi 


A  tilt  off  of  the  east  direction,  caused  by  an  east-west  bearing  deflec¬ 
tion,  is  represented  by  the  angle  <f>  ;  a  tilt  of  the  north  direction, 

yc 

caused  by  a  north-south  bearing  deflection,  is  represented  by  the  angle 
As  discussed  in  Section  3.  1,  the  main  spindle  verticality  should 
be  within  a  few  arc -seconds,  so  that  the  following  small  angle  trans¬ 
formation  can  be  used  to  depict  the  earth  frame  e  to  misaligned  spindle 
axis  frame  c'  transformation. 


0 
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•0, 


yc 


0. 


xc 


-0. 


xc 


(3.6) 


The  second  intermediate  transformation  shown  in 
Figure  3.  5  is  required  to  establish  a  physical  time  reference  during 
the  calibration  program.  One  of  the  dynamic  radius-measuring  stations 
discussed  in  Section  3.  1  is  used  to  provide  a  pulse  per  revolution  of 
the  centrifuge.  The  electronic  pulse  is  used  to  secure  an  initial  condi¬ 
tion  (t  =  0)  time  reference  and  to  determine  the  average  centrifuge 
angular  rate  by  measuring  the  time  between  pulses.  The  1-pulse-per- 

revolution  axis  frame  is  defined  with  the  Z  axis  coincident  with  the 

ppr 

centrifuge  spindle,  the  X  ax>s  directed  toward  the  pulse-per- 
revolution  station,  and  the  Y  y  axis  completes  the  orthogonal  set. 

From  Figure  3.  5,  the  transformation  from  the  misaligned  spindle 
axis  frame  to  the  pulse -per -revolution  frame  is 
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COS  0 

rzc 


sin  0 

7.  C 


0 


sin  0 

zc 


COS  0 

7.C 


0 


(3.7) 


where 

0  = 90°  -  0 

rzc  PPr 

0p^r  =  astronomic  heading  of  the  1 -pulse -per -revolution  (ppr) 
station  with  respect  to  north 

The  astronomic  heading  [13]  is  by  definition  the  clockwise  angle  mea¬ 
sured  from  north  to  the  pulse -per -revolution  station. 

The  last  intermediate  transformation  shown  in  Figure  3.5 
transforms  the  ppr  axis  frame  into  the  centrifuge  main  arm  frame. 

The  main  arm  frame  is  defined  with  the  Z ^  axis  along  the  centrifuge 
spindle,  the  axis  directed  outward  along  the  centerline  of  the  main 
arm  and  through  the  center  of  the  counter-rotating  platform,  and  the 
axis  completes  the  orthogonal  set.  The  transformation  is 


CC 

ppr 


COS  0 

-sin  0 
0 


sin  0 
cos  0 
0 


0 

0 

1  _ 


(3.8) 
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I 

where 

< p  =  0+0 

C  O 

0q  =  angle  from  1 -pulse -per -revolution  contact  to  main  arm 
centerline  through  center  of  CRP  at  t  =  0 

* c  /‘“c  dl 

0 

CO  =  CO  +  6  CO 

c  co  c 

co^^  =  average  centrifuge  angular  rate 

6co  =  centrifuge  rate  variation  about  the  average  rate  caused  by 
c 

variations  in  the  main  arm  drive  system 


Equations  (3.6)  through  (3.  8)  give  the  following  trans- 


Cc  =  Cc  cP?r  Cc' 
e  ppr  c  e 


main 

arm 

frame. 

1  1 

C  1 2 

C  13 

Z1 

C22 

C23 

1 

(3.9) 

31 

c32 

1 

CO 

CO 

u 

where 


c.  .  =  cos  0  cos  0  -  sin  0  sin  0 

11  zc  1  z  c 

c1?~cos0sin0  +sin0cos0 
A  £  ZC  ZC 

c.,  -cos  0  cos  0  *0  +  cos  0  sin  0  *0 

13  zc  yc  rzc  rxc 


+  sin  0  sin  0*0  +  sin  0  cos  0  *0 

zc  ryc  rzc  xc 
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C21  =  "sin  ^  COs  -  cos  0  sin  0 

zc  rzC 

C22  r  "sin  ^  sin  +  cos  0  cos  0 

rzc 

C23  =  sin  *  cos  «zc  •  0yc  -  sin  0  sin  0  .  0 

y ^  zc  xc 

+  cos  0  sin  •  0yc  +  c„s  p  CO,  ^  ^ 

C3 1  =  V 

C32  =  "^xc 


The  matrix  repreaentation  of  the  rotation  of  the  centrifuge  with  reaped 
to  the  earth  frame,  coordinatized  in  the  centrifuge  axes,  is 


c 

u> 

ec 


=  {0, 


(3.  10) 


Therefore,  the  cross-product  matrix  is 


Wck 

ec 


-CO 

c 


0 

0 


0 

0 

0 


(3.  11) 


Since  the  origins  of  the  earth  and  centrifuge  main 

same,  the  scalar  distance  R  =  o 

ec 


arm  frame  are  the 
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1 . 2 .  3  Centrifuge  Main  Arm  -  Centrifuge  Counter-Rotating 
Platform  Transformation 

Two  intermediate  transformations  are  required  to  link 
the  centrifuge  main  arm  frame  to  the  centrifuge  counter-rotating  plat¬ 
form  frame.  The  first  transformation  shown  in  Figure  3.  6  accounts 
for  any  variation  of  the  CRP  spindle  axis  with  respect  to  the  centrifuge 
main  arm  axes.  In  other  words,  it  accounts  for  misalignments  that 
exist  between  the  main  spindle  and  CRP  spindle,  since  the  centrifuge 
main  arm  vertical  axis  is  coincident  with  the  main  spindle  axis.  The 
angles  0xr  and  0  represent  static  as  well  as  dynamic  misalignments 
due  to  g-loading.  Since  both  the  main  and  CRP  spindle  verticality  are 
within  a  few  arc -seconds,  the  misalignment  between  the  two  spindles 
should  be  within  a  few  arc -seconds.  Consequently,  the  following  small 
angle  transformation  can  be  used  to  depict  the  centrifuge  main  arm 
frame  to  misaligned  CRP  spindle  axis  frame  r'  transformation. 


The  last  transformation  shown  in  Figure  3.  6  transforms 
the  misaligned  CRP  spindle  axes  into  the  CRP  axis  frame  r. 


(3. 13) 
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win*  re 


6  =0+0 
r  o 

e0  =  angle  between  X  and  X  axes  at  t  =  0 

r  c 

0  =  f t  CO  dt 

r  J  r 
0 

w  =  CRP  angular  rate  =  u  +  6cj 

c  r 

=  “co  +  6wc  +  6wr  fRcference  Eq.  (3.8).] 

6wr  CRP  rate  uncertainty  caused  bv  variations  in  the 
CRP  drive  system 


Equations  (3.12)  and  (3.  13)  give  the  total  transformation: 


c 


:11 

C 1  2 

C  1  3 

21 

C22 

C23 

31 

C32 

C33 

(3.  14) 


whe  re 


c  j  J  =  cos  0 
Cj2  =  -sin  0 

CI3  =  -cos  0  •  0  _  sin  0*0 

J  Yr  xr 

=  sin  0 

c 2.2  ~  cos  G 

c2'i  r  -sin  0*0  +  cos  0  •  0 

Yr  xr 
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c,  .  0 

3 1  yr 


c,0  -0 

32  xr 


C33  1 


The  rotational  and  cross-product  matrices  are 


0,  -«r}  (3.15) 

u  0  ~ 

r 

0  0 

0  0 

The  scalar  distance  between  the  coordinate  frames  is 

R  r  +  6  r  (3.16) 

c  r  o 

where 

r  =  nominal  260-inch  radius 
o 

6r  =  static  and  dynamic  change  in  the  radius  from  nominal 

Measurements  of  the  centrifuge  radius  have  shown  that,  once  the 

centrifuge  is  stabilized  at  a  specified  g-level,  the  dynamic  change  in 

radius  or  stretch  remains  constant,  implying  that  the  change  is  mainly 

due  to  g -loading,  rather  than  aerodynamic  heating.  Consequently, 

R  can  be  considered  a  constant  at  each  g-lcvel. 
cr  h 


cj  -  { 0, 
c  r  1 


W 


rk 

cr 


-w 
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As  mentioned  in  .Section  t,  the  purpose  of  the  counter- 
minting  platform  is  to  isolate  the  platform  gyros  from  the  centrifuge 
angular  rate.  Perfect  isolation  i  mpl  ie  s  per  feet  rountc  r -rotation; 
however,  the  transformations  of  this  section  reveal  that  misalignment 
between  the  two  spindles  and/or  variations  in  either  the  main  or  CRP 
drive  system  prevent  perfect  counter-rotation.  Therefore,  a  component 
of  centrifuge  rate  will  be  sensed  by  the  platform  gyros.  If  the  magni¬ 
tude  of  angular  rate  is  large  enough  to  stimulate  instrument  error 
terms  proportional  to  rate,  then  the  models  of  Section  2  must  be  ex¬ 
panded  to  include  those  effects.  Measurement  data  taken  thus  far  on 
the  centrifuge  environment  shows  lhat  expansion  of  the  performance 
models  is  not  necessary.  However,  the  component  of  centrifuge  rate 
is  large  enough  to  mask  the  d r  i ft -producing  terms  contained  in 
Eq.  (2.20).  As  shown  by  Thcclo  [l  l],  a  CRP  axis  misalignment  of 

-8 

5  arc-seconds  gives  a  component  of  centrifuge  rate  equal  to  9.48  V  10 

rad/sec  at  the  10 -g  operating  level  of  the  centrifuge.  This  compares  to 

-8 

a  nominal  value  of  a  gyro  compliance  term  (  such  as  Djj)  of  23. 7  X  10 

rad/sec.  The  centrifuge  rate  that  is  sensed  by  the  platform  gyros, 

whose  outputs  drive  the  platform  via  the  stabilization  loops  to  null  the 

sensed  rate,  must  be  accounted  for  to  distinguish  between  the  platform 

motion  due  to  sensed  centrifuge  rate  and  motion  due  to  the  drift  terms. 

The  term  in  the  platform  rate  equation,  Eq.  (2  33).  that  accounts  for 

r 

the  centrifuge  rate  effect  is  w.  . 
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r  _r  e  ,  _r  c  ,  r 
co.  -  C  co.  +  C  co  t  w 

ir  e  le  c  ec  cr 


0 

0 

~r  e  r 

-  C  co.  +  C 

0 

+ 

0 

e  le  c 

co  +  6oo 

-co  -  6go 

CO  c 

c  r 

So  the  variations  in  the  main  and  CRP  drive  system  are  represented, 
and  the  misalignments  are  contained  in  the  transformation  given  by 
Eq.  (3.  14).  The  important  point  is  that  the  misalignments  and  rate 
variations  must  be  measured  quantities.  If  the  measurement  accuracy 
is  not  sufficient  to  accurately  account  for  the  centrifuge  rate  effect, 
then  these  parameters  must  also  be  estimated  by  the  filtering  process. 

The  Inertial  Navigation  System  will  be  mounted  on  a 
fixture  located  on  the  CRP.  Since  the  mounting  fixture  is  aligned  and 
leveled  by  extremely  accurate  laboratory  optical  equipment,  the 
mounting  fixture  or  system  platform  base  frame  will  be  made  coincident 
with  the  CRP  frame.  Therefore,  the  transformation  from  the  centifuge 
CRP  frame  to  the  system  inner  gimbal  platform  frame  will  be  identical 
to  the  platform  base  to  inner  platform  p  frame,  C^  ,  which  will  be 
defined  in  Section  4. 

3.2.4  System  Inner  Gimbal  Platform-Sensor  Transformation 

The  system  inner  platform  axes  are  defined  by  three 
fiducial  lines  that  are  physically  inscribed  on  the  platform.  The 
inertial  instruments  also  have  a  case  axis  system  which  is  physically 
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inscribed  on  the  case  and  referenced  to  a  precision  mounting  surface. 
The  instruments  are  mounted  so  that  the  case  input  axes  are  aligned 
with  the  platform  inscribed  axes.  In  other  words,  the  X,  Y,  and  Z 
gyro  case  input  axes  establish  the  direction  of  the  inner  platform  axes. 
The  instruments  are  located  as  close  as  is  physically  possible  to  the 
origin  of  the  platform  frame  and  are  distributed  about  the  origin  to 
maintain  a  balanced  inner  gimbal.  The  accelerometer  and  gyro  case 
axi  s  system  for  the  Ca  rouse  1  V R  |  1 0]  are  illustrated  in  Figures  3  .  7 
and  3.8,  respectively.  Therefore,  the  locations  of  the  instruments  are 
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(0. 
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-accelerometer) 
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p. 

AZ 

{0. 

1.0, 

1.5} 

(Z- 

-accelerometer) 

The 

true 

sen  s 

itive  or  in 

put  axis 

j  of  an  accelerometer  is 

based  on  the  physical  structure  of  the  output  axis  and  pendulous  ele¬ 
ment.  •  The  true  input  axis  will  be  misaligned  witi  respect  to  the  case 
axes.  The  sensor  frames  are  defined  by  the  true  input  axes.  Fig¬ 
ure  3.0  illustrates  the  inner  platform -to-sensor  transformations  for 
the  X,  Y,  and  7  accelerometers. 
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The  same  applies  to  the  gyro  whose  true  input  axis  is 
the  gyro  gimbal  element  structure.  Figure  3.  10  illustrates 
platform-to -sensor  transformations  for  the  X,  Y,  and  Z 
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CASE  -  TRUE  COORDINATE  FRAME 

Figure  3.  10.  Platform  -  Gyro  Coordinate  Fra 
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(3. 20) 


Since  the  instruments  are  mounted  to  the  inner  platform,  there  is  no 
rotation  between  the  inner  platform  and  sensor  frames.  This  com¬ 
pletes  the  coordinate  transformations. 


3.3  APPLIED  ACCELERATION  EQUATION 

The  acceleration  applied  to  the  sensors  is  a  combination  of  the 
local  gravitational  and  kinematic  accelerations.  A  general  ec,uation 
for  the  kinematic  acceleration  of  t ho  sensor  frame  with  respect  to  the 
inertial  frame  is  developed  in  Appendix  A  and  the  results  contained  in 
Eq.  (A.  31).  Based  on  the  coordinate  frames  and  transformations 
defined  in  Section  3.2,  in  conjunction  with  Eqs.  (A.  1)  and  (A.  2)  for 
differentiation  of  a  vector,  the  following  simplifications  can  be  made 
to  Eq.  (A.  31)  for  application  to  the  centrifuge  environment; 

(a) 

(b)  R1  <j j.  X  (u>.  X  R.  ),  which  can  be  combined  with  the 

—  ic  — ic  — jo  — te 

uj  X  (w  X  R  )  term  in  Eq.  (A.31)  to  give  i*>.  X  (+>■  X  R  ) 
—ic  —it!  — es  1  ^  — ic  — ic  — is 

•  •  (>  •  (» 

(c)  R  R  R  0,  since  the  earth  and  centrifuge  main 

arm  frame  have  a  common  origin 

•  •  c  •  c 

(d)  R  =  R  0,  since  the  centrifuge  radius  is  assumed 

— c  r  — c  r  ^ 

constant  at  an  operating  g-le\cl  and  the  origin  of  the  CRP 
frame  rotates  with  the  centrifuge  main  arm 


d!  0,  sime  earth  rate  is  constant 
—1  e 
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•  •  r  •  J. 

(e)  M.rp  =  Hrp  =  B.rp  0,  since,  by  alignment  of  the  mounting 
fixture,  the  CRP  frame  origin  is  coincident  with  the  inner 
platform  frame  origin 

(f)  RK  =  R^  =0,  since  the  distance  to  each  sensor  is  a 

— ps  — ps 

constant  and  the  sensors  are  fixed  to  the  inner  platform 
Equation  (A.  31)  reduces  to 


R1  =  u>C  X  R  +  X  R  +  <L‘  X  R 
— is  — ec  — cs  — cr  — ps  — rp  — ps 


•  c 


•  r 


+  2cj.  X(co  XR  +w  XR  +w  XR  ) 
— le  — ec  — cs  — cr  — ps  — rp  — ps 


+  2W  X  (oj  XR  +w  XR) 
— ec  — cr  — ps  — rp  — ps 


+  2w  X  (ui  X  R  )  +  oj.  X  (ui.  X  R.  ) 
-cr  —  rp  — ps  — le  — le  — is 


+  w  X  (w  X  R  )  +  u,  X  (w  X  R  ) 
— ec  — ec  — cs  — cr  — cr  — ps 


+  w  X  (w  X  R  ) 
— rp  —  rp  — ps' 


(3.21) 


The  mass  attraction  term  taken  with  respect  to  the  sensor  frame  is 

G  M 
c  c 

1D  — — y—  ;  and,  adding  the  *>.  X  (w.  X  R.  )  term  from  Eq.  (3.21), 

— R.  d  £  *  — le  —  le  — is  \ 

is  K . 

1  s 

we  arrive  at  the  local-gravity  vector  with  respect  to  the  sensor  frame 
[Reference  Eq.  (3,5)]. 


s 
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ui. 

— le 


X  (w. 
— le 


X  R.  ) 
— is 


-R. 


is 


G  M 
e  e 


(3.  22) 
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Define 


w  -w  t  A  w  (  t .  2  3 ) 

— c  r  — e  c  — 


where 


Aw  =  uncertainty  in  the  counter-rotation  rate  due  to 
misalignment  between  the  two  spindles  and/or 
variations  in  either  the  main  or  CRP  drive  system 


Combining  Eqs .  (3.21),  (3.22),  and  (3.23);  expanding  the  vector 
cross-products;  and  simplifying  leads  to  the  following  vector  expres¬ 
sion  for  the  total  acceleration  applied  at  the  sensor  frame  with  respect 

to  the  inertial  frame  A1  . 

— is 


A!  =  £.e  X  R  +  wC  X  R  +  i1'  X  R 

— is  —  ec  — cs  — cr  — ps  — rp  —ps 


+  2w.  X  (w  XR  )  t  2  ui.  X  (Aw  X  R  ) 
— ic  — ec  — cr  — le  —  — ps 


+  2w-  X  (w  X  R  )  +  2Aw  X  (u >  X  R  ) 
— ic  — rp  — ps  —  — rp  — ps 


+  w  X  (oj  XR  )  +  w  X  (Aw  X  R  ) 
— ec  — ec  — cr  — ec  —  — ps 


-Aw  X  (w  X  R  )  +■  Aw  X  (Aw  X  R  ) 

C  C  p  S  “”*■  p  & 


+  w  X  (w  X  R  )  +  g' ■ 

— rp  —  rp  — ps  *■ 


(3.24) 


Since  the  platform  rate  and  platform  acceleration  equations  [Eqs.  (2.33) 
and  (2.34),  respectively)  use  the  components  of  applied  acceleration  in 
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the  sensor  frame,  we  require  the  matrix  form  of  Eq.  (*.24) 
coordinatized  in  the  sensor  frame. 


A8  =  c8  CP 

is  p 


2Wek  Ce  Wck  Rc 
ie  c  ec  cr 


+  awf!1  c'  C=  AW'!:  cr  RP  t  Ge 


ie  c  r 


cr 


P  ps 


*[* 


ck 
ec  cs 


+  wr:  r^_  +  wck  wck  rc 


ec  ec  cr 


+  W^k  C*  AWrk  cr  rP  1 

ec  r  cr  p  psl 

fwrk  Cr  RP  -  AWrk  Cr  Wck 
L  cr  p  ps  ^  cr  ^c  Wec 

+  AWrk  AWrk  Cr  rp1( 
cr  cr  p  psl  ( 


Cc  Cr  RP 
r  p  ps 


+  CS  CP 
P 


r  H  C^[2Wic  Cc  C'r  c;  <  Rps] 

*  Cp[*rp  R£s  +  w?p  Kp  R£s] 

+  Cp  WrpR?JJ 


(3. 


indicates  Group  1 
indicates  Group  2 


where 


W 


\V 


eK 

ie 

ck 

ec 


is  given  oy  Eq.  (3.  3) 
is  given  by  Eq.  (3.  11) 
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r  k 

W  -  is  given  by  Eq .  (3.  15)  with  w  gjc  =  u>co,  since  the 
6wr  and  a uc  effects  are  now  acc  mnted  for  in  the 
Aujj'  term 


cr  (6wr  f  6wc) 


•(ou  +  6go  )  0 

r  c 


0  [Reference  Eq.  (3.  13)] 


U  -GJ  GJ 

zp  yp 

gj  0  -gj  [Reference  Eq.  (2.33)] 

rp  zp  xp  L  J 

-GJ  GJ  0 

L  yp  xp 

•  ®rlc  •  nj^ 

W  ,  W  .  -  a^e  the  cross-product  form  of  the  angular 

cc  cr  rn  *  ° 

F  accelerations  for  the  centrifuge,  CRP,  and 

platform,  respectively 

Ge  =  {0,  0,  g}  is  the  gravitational  acceleration  in  the  earth 
frame,  where  g  is  the  magnitude  of  Eq.  (3.5) 

Rcr  <ro  +  V  °*  [Refcrence  Eq.  (3-  l6)] 


R  -  is  given  by  Eq.  (3.  18)  for  the  specific  sensor  for  which 
"  the  applied  acceleration  is  being  determined 

R°  RC  1  Cc  Cr  RP 
(s  cr  r  p  ps 


C  -  is  given  by  Eq.  (3.9) 


C(  -  is  given  by  Eq.  (3.  14) 


CP  -  will  be  given  in  Section  4 


C  -  is  given  by  Eq.  (3.  1^)  for  the  accelerometers  and 
P  Eq.  (3.20)  for  the  gyros 
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*  -  ["a]' 


for  a,  b  =  e,  c,  r,  p,  s.  In  other  words, 
for  all  the  C  transformations  between  any 
two  of  the  coordinate  frames,  the  trans¬ 
formations  are  orthogonal,  and,  therefore, 
the  matrix  inverse  is  equal  to  the 
transpose  [7], 

Group  1  and  Group  2  terms  are  defined  as  the  desirable  and 

undesirable  terms,  respectively,  and  will 
be  discussed  later  in  the  text. 


The  applied  acceleration  equation  provides  the  sensor  compo¬ 
nent  accelerations  for  the  platform  rate  equation,  Eq.  (2.33),  and  the 
platform  indicated  acceleration  equation,  Eq.  (2.  34).  The  procedure 
for  the  platform  rate  equation  is  to  obtain  a  solution  of  the  applied 
acceleration  for  each  of  the  three  gyros. 

SGX  (  j 

A.  =  |aix>  a0X'  aSX)  is  obtained  from  Etl-  (3.25)  with 

RP  =  RP  reference  Eq.  (3.  18), 

ps  p,  LiA 

and  CS  =  CSGX,  reference  Eq.  (3.20). 

P  P  MV/ 

SQV  i  \ 

A.  gQY  =  {aIY'  aOY’  aSYl  °bta*nec*  frorn  Eq.  (3.25)  with 

RP  =  Rp  _v  and  CS  =  CSGY. 
ps  p,  GY  p  p 

SGZ  [  \ 

Ai  5Q2  =  | aIZ '  aOZ’  aszf  *S  °^ta^nec^  from  Eq.  (3.25)  with 

Rp  =  Rp  and  CS  =  CSGZ. 
ps  p,  GZ  p  p 


The  procedure  for  the  platform  indicated  acceleration  equation  is  to 
obtain  a  solution  of  Eq.  (3.25)  for  each  of  the  three  accelerometers. 
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SAX  (  ) 

A.  =  \a^x»  apx'  aOAX|  1S  °bta*nec*  from  Eq.  (3.  25)  with 


RP  =  RP  AY  and  CS  =  CSAX, 

ps  p,AX  p  p 


reference  Eq.  (3.  19). 


SAY  (  ) 

Ai,SAY  =  iaIAY’  aPY '  aOAYf  is  obtained  from  Eq.  (3.  Z5)  with 


rP  =  rP  av  and  cS  =  CSAY . 
ps  p,  AY  p  p 


Ai  SAZ  ~  {aIAZ  aPZ*  aOAZ|  *S  obtadned  from  Eq.  (3.25)  with 


Rp  Rp  a_  and  Cs  =  CSAZ, 
ps  p,AZ  p  p 


Note  that  the  aQ^  terms  are  not  used  in  Eq.  (2.34);  therefore,  only 
the  a^  and  ap  terms  need  to  be  determined. 

Because  the  component  solutions  of  the  applied  acceleration 
equation  are  embedded  in  the  platform  rate  equations,  a  careful 
observation  of  the  terms  in  Group  2  will  show  why  this  group  is  unde¬ 
sirable.  The  terms  in  Group  2  consist  of  platform  rate,  rate  of 
change  of  platform  rate  (i.e.  ,  platform  acceleration),  and  higher- 
order  products  and  cross-products  of  the  platform  rate.  Embedding 
these  terms  implies  that  the  set  of  equations  in  Eq.  (2.  3  )  will  be 
nonlinear,  coupled,  differential  equations.  These  equations  would 
have  to  he  solved  at  least  each  cycle  of  the  filtering  process  to  obtain 
values  lor  the  platform  r.iles,  !•  n  1 1  im.il  <-l  y  ,  it  will  b<  shown  in  ?  »e< 
lions  5  and  6  that  these,  terms  cun  he  made  nugll;  ihh  hy  limiting  the 
magnitude  of  the  commanded  angular  rate  and/or  i  sing  the  commanded 
angular  rate  to  decrease  the  platform  rate  contribution  of  the  drift 
terms.  Note  that  if  all  the  inertial  sensors  verc  located  precisely 

at  the  center  of  the  inner  platform,  1<P  would  he  zero  and  all  the 

ps 
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Group  2  terms  would  vanish;  in  fact,  five  terms  in  Group  1  would  also 
vanish.  However,  since  it  is  physically  impossible  to  do  this,  the 
Group  2  terms  must  be  evaluated  to  determine  if  their  contribution 
can  be  neglected  without  affecting  the  accuracy  of  the  error  model 
coefficient  estimates. 

In  the  next  section,  the  platform  rate  and  indicated  accelera¬ 
tion  equations  will  be  related  to  the  state  and  measurement  dynamic 
equations,  followed  by  the  development  of  the  extended  Kalman  filter 


equations . 


SECTION  4 


EXTENDED  KALMAN  FILTER  EQUATIONS 

The  platform  rate  and  indicated  acceleration  equations  developed 
over  the  last  two  sections  will  now  be  used  to  define  the  state  and  mea¬ 
surement  equations.  Once  these  equations  are  defined,  the  recursive 
filtering  algorithm,  which  formulates  the  basis  for  the  data  reduction 
technique,  will  be  developed  from  the  extended  Kalman  filter  equations. 

Unfortunately,  the  rather  laborious  development  of  the  platform 
Eqs.  (2.  33)  and  (2.  34)  was  necessary  to  understand  how  one  can  obtain 
a  prediction  of  the  platform  velocity  to  compare  with  the  actual  plat¬ 
form  velocity  measurement.  As  will  be  shown  later,  the  difference 
between  the  actual  and  predicted  measurement,  called  the  measure¬ 
ment  residual,  is  used  to  correct  the  filter  in  such  a  fashion  that  the 
estimates  of  the  defined  state  variables  will  be  "improved,"  assuming 
the  actual  measurements  provide  the  best  information  available.  A 
brief  review  of  the  development  to  this  point  will  show  which  variables 
constitute  the  "state"  of  the  calibration  problem. 

4.1  STATE  VARIABLES 

As  mentioned  in  Section  1,  the  objective  is  to  obtain  estimates 
of  inertial  sensor  error  model  coefficients.  In  the  gyro  performance 
model  equation,  Eq.  (2.20),  the  bracketed  term  contains  an  expansion 
of  the  internal  gyro  error  sources.  This  expansion  is  actually  a  math¬ 
ematical  error  model  that  represents  a  general  expression  for  those 
typical  errors  found  during  14  years  of  gyro  testing  at  Holloman  AFB. 

Preceding  page  blank 
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Which  terms  apply  to  a  specific  gyro  depends  on  the  physical  structure 
and  assembly  of  the  gyro.  Therefore,  the  first  task  is  to  identify  the 
terms  of  the  error  model  that  represent  the  physical  gyro  error  drifts. 
The  second  task  is  obviously  to  obtain  estimates  of  the  coefficients  for 
those  terms  that  are  identified. 

Sage  [15]  discusses  one  method  of  identifying  parameters  of  a 
system,  assuming  you  know  the  general  struct  ire  of  the  system 
dynamic  equations  containing  the  pa r amete r s .  It  consists  of  defining 
the  parameters  as  state  variables  and  reformulating  the  problem  as  a 
state  estimation  problem.  The  form  of  the  state  estimation  problem 
considered  in  this  dissertation  is  shown  in  Figure  4.1.  The  system 
dynamic  model  contains  tin  unknonwn  error  coefficients  defined  as 
state  variables.  The  output  z(t)  is  a  corrupted  version  of  the  state 
x(t)  due  to  the  measurement  noise  v(t).  Assuming  the  statistics  of  the 
system  disturbance  w(t)  and  measurement  noise  are  known,  we  desire 
to  determine  a  "best"  estimate  x(t)  of  the  true  system  state  x(t)  from 
a  knowledge  of  z(t). 

Based  on  the  above,  the  error  model  coefficients  for  all  three 
gyros  represented  in  Eq.  (2.  33)  are  designated  as  state  variables. 

The  commanded  angular  rate  term  of  Eq.  (2.20)  is  comprised  of  an 
unknown  torquer  scale  factor  times  a  known  command  torque  t^,  shown 
in  Eq .  (2.  33).  The  torquer  scale  factor  of  each  gyro  is  defined  as  a 
state  variable.  The  final  gyro  parameters  defined  as  state  variables 
are  the  misalignment  angles  given  in  Eq .  (3.20)  and  represented 
explicitly  in  the  platform  rate  equation  and  implicitly  via  the  applied 
acceleration  terms  of  Eq.  (3.25),  which  are  embedded  in  the  platform 
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Figure  4.  1.  State  Estimation  Proble 


rate  equation.  This  implies  that  the  platform  rate  equations  are 
nonlinear  functions  of  the  state  variables. 

The  same  philosophy  is  used  in  rlesi gnating  accelerometer 
parameters  as  state  variables.  Equation  (2.25)  is  a  mathematical 
error  model  that  represents  12  years  of  testing  experience  at  Hollo¬ 
man  AFB.  Except  for  the  a^  term,  it  is  identical  to  the  performance 
model  given  in  Eq .  (2.26).  Consequently,  the  K  coefficients  for  all 
three  accelerometers  represented  in  Eq.  (2.34)  are  defined  as  state 
variables.  In  addition,  the  accelerometer  misalignment  angles  defined 
in  Eq.  (3.  19)  and  represented  implicitly  in  Eq.  (2.  34)  via  the  applied 
acceleration  terms  are  designated  state  variables.  Therefore,  the 
platform  acceleration  equation  is  also  a  nonlinear  function  of  the  state 
variables . 

To  obtain  a  prediction  of  the  platform  velocity  profile  requires 
the  knowledge  of  the  inner  platform  angular  position  as  a  function  of 
time.  Since  the  platform  rate  equations  are  a  function  of  the  estimated 
states,  the  best  we  can  do  is  to  obtain  an  estimate  of  the  platform  angu¬ 
lar  position.  Therefore,  the  last  three  state  variables  are  the  Euler 
angles  ,y ,  (3,  and  \  that  track  the  inner  platform  motion  with  respect 
to  the  platform  base  (which  was  showi  in  Section  3.  2.  3  to  be  identical 
t<*  lli«*  ( .  I  <  I  ’  I  r.  1 1 1 1  >* )  A  lint  i  >  |  tin*  til  ii  I  .i  i  •-  ti  ol  tin-  i  .i  1 1 1 1 1  ii  1 1 1 1 1 1  proi  n  m  a 
i  s  gi  ven  in  I'.i bio  4,  ! . 
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lable  4.  1.  States  of  the  Calibration  Process 


xi  =  dfx 

X17  =  DOOY 

X33  =  TSFZ 

X49  =  K3X 

X2  =  DFY 

X18  =  DOOZ 

x,.  i  n 

34  Xj 

X50  =  K3Y 

X3  =  DFZ 

X19  =  DSSX 

35  xo 

X51  =  K3Z 

X4  =  DIX 

X20  =  DSSY 

X36  =  nyi 

X52  =  KlpX 

X5  =  DIY 

X21  =  DSSZ 

X37  =  ny 

7  o 

X53  =  KIPY 

X6  =  DIZ 

X22  DlOX 

X38  =  V 

X54  =  KIPZ 

X7  =  D0X 

X23  =  DlOY 

X39  =  nZo 

X55  *x. 

1 

X8  =  DOY 

X24  =  DlOZ 

X40  =  KOX 

X56  ■  *x 

A 

X9  =  DOZ 

X25  DISX 

X41  =  KOY 

u 

Xr?  =  ^ 

57  Y; 

xio  =  Dsx 

X26  =  DISY 

X42  =  KOZ 

i 

X58  =  *y 

7  o 

X11  =  dsy 

X27  =  DISZ 

X43=K1X 

X59  '  V 

1 

X12  =  DSZ 

X28  =  DOSX 

X44^K1Y 

l 

X60  = 

n 

X13^D„X 

X29  DOSY 

X45  =  K 1 Z 

u 

X6l  =  * 

X14  =  DIIY 

X30  DOSZ 

X46  K2X 

X62  =P 

X15  =  DIIZ 

X16  =  DOOX 

X31  TSFX 

X  32  TSFy 

X47  =  K2Y 

X48  -  K2Z 

X63  s  V 
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4.2  SYSTEM  DYNAMIC  MODEL 


The  system  dynamic  model  consists  of  a  set  of  Euler  rate 
equations  that  describe  the  motion  of  the  inner  platform  during  the 
calibration  process.  Since  the  motion  of  the  platform  is  uncon¬ 
strained,  large  angle  trans formations  are  involved,  which  implies 
that  the  order  of  rotation  must  be  specified.  Th^  sequence  of  rota¬ 
tions,  shown  in  Figure  4.2,  which  give  the  orientation  of  the  inner 
platform  frame  p  with  respect  to  the  CRP  frame  r,  is  (o,  3,  y)  about 
the  moving  frame  (x,  z,  y)  axes  respectively.  From  Figure  4.2,  the 
orthogonal  Euler  transformatic  n  from  the  r  to  p  frame  is 


‘Elf 

E12 

E  1  3 

CP 

r 

E21 

E22 

E23 

-E31 

E32 

E33- 

where 


E11 

cos  y 

cos 

E 12 

=  cos  y 

sin 

E 1  3 

-  cos  y 

sin 

E21 

-sin  f: 

1 

E22 

-  cos  3 

cos 

E2  3 

cos  3 

sin 

E31 

sin  y 

cos 

3 

3  cos  a  +  sin  y  sin  a 
3  sin  a  -  sin  y  cos  a 

a 

a 

3 


bl 


E  ^  -  sin  V  sin  3  cos  a  -  cos  y  sin  a 

E.^  sin  y  sin  ^  sin  or  +  cos  y  cos  a 

The  platform  rates  are  a  function  of  the  gyro  states,  reference 
Eq.  (2.  33),’  implying  that,  if  the  Euler  rate  equations  are  a  function  of 
the  platform  rate,  then  the  Euler  angles  will  represent  the  drift  gen¬ 
erated  by  the  gyro  states  at  any  point  in  time.  Now  the  applied  accel¬ 
eration  terms  contained  in  Eq.  (2.34)  are  a  function  of  the  Euler  angles 
via  the  transformation  in  Eq.  (3.25).  Consequently,  the  gyro  states 
are  represented  in  the  measurement  process.  As  shown  by  Figure  4.1, 
the  system  output  z(t),  which  is  the  measurement  equation,  must  be  a 
function  of  the  system  states  as  a  minimum  criterion  for  the  system  to 
be  observable  [  1 6 ] .  However,  just  because  the  states  are  represented 
in  the  measurement  process  does  not  imply  that  the  system  will  be 
observable.  If  the  measurement  information  is  such  that  the  filter¬ 
ing  process  has  difficulty  distinguishing  between  the  states,  then  we 
say  *hat  the  states  (which  will  be  shown  to  be  random  variables  in  the 
next  section)  are  highly  correlated  and  therefore  the  system  b}  defini¬ 
tion  is  unobservable  [  1 6  ].  Because  of  the  concern  for  this  observabil¬ 
ity  problem,  a  care/ul  evaluation  was  made  of  the  filtering  process 
during  the  simulations  that  are  described  in  Sections  5  and  6.  One 
significant  discovery  that  was  made  during  the  simulations  was  that 
the  system  observability  could  be  monitored  quite  effectively  by  deter¬ 
mining  the  level  of  correlation  that  existed  between  the  Euler  angle 
states.  It  was  found  that  command  torquing  was  very  effective  in  off¬ 
setting  the  effect  of  the  unobservability  condition. 
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Based  on  the  above,  we  now  seek  an  expression  for  the  Euler 
rate  as  a  function  of  platform  rate.  Referring  to  Figure  4.2,  we 
resolve  the  Euler  rates  into  the  inner  platform  frame  p.  The  matrix 
form  of  the  resulting  resolution  is 


co 


xp 


u> 


yp 


zp 


[“cos  y  cos  P  -sin  y  0 


■  sin  3 


J  L  sin  y  cos  3  cos  y  Oj 


(4.2) 


Solving  the  matrix  expression  for  the  Euler  rate  equations  gives 


a  =  (u>  cos  y  +  w  sin  \)/cos  3 
xp  1  zp  T 


3  =  w  cos  y  -  w  sin  y 
zp  1  xp  1 


Y  =  (w  cos  y  sin  3  +  u,  sin  y  sin  P)/cos  3  +  to 

xp  zp  yp 


(4.  3) 


where  the  Euler  angles  are  limited  to  the  following  ranges  to  avoid  the 
singularity  that  occurs  when  3  ±  90°. 

0  <  a  <  2tt 

TT  „  TT 

•2  -  3  <  I 

0  Z  y  2it 

Since  the  initial  value  of  the  Euler  angles  (i.  e.  ,  at  t  -  0)  represents 
the  small  misalignments  of  the  inner  platform  with  respect  to  the  CRP 
frame,  a  Euler  rotation  seqaence  that  provided  a  cosine  term  xn  the 
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denominator  of  Eq.  (4.3),  rather  than  a  sine  term,  was  selected.  We 
can  see  that  another  reason  for  command  torquing  the  platform  is  to 
prevent  3  from  reaching  the  singularity  condition.  We  now  have  all 
the  equations  necessary  to  define  the  state  and  measurement  equations 
for  the  calibration  process. 

4.3  STATE  AND  MEASUREMENT  EQUATIONS 

A  "technical  battle"  is  presently  being  waged  in  the  literature 
concerning  the  proper  choice  of  a  statistical  model  or  models  for  gyro 
and  accelerometer  error  coefficients  (4,  5,  6].  Unfortunately,  the 
classical  Gauss-least- squares  approach,  which  has  no  probabilistic 
meaning,  was  used  for  a  number  of  years  to  obtain  data  from  inertial 
sensors.  As  discussed  by  .lazw inski  [  1 7 ]  ,  there  is  no  need  to  make 
any  assumptions  about  the  system  noise,  since  the  problem  is  one  of 
minimizing  deterministic  errors  in  the  least- squa res  approach.  With 
the  advent  of  Kalman  filter  applications,  a  statistical  description  was 
required  for  the  system  disturbance  and  measurement  noise 
(Reference  Figure  4.1)  in  addition  to  the  initial  value  of  the  state 
x(t^).  Consequently,  for  the  last  o  years,  a  major  •  fforl  has  been 
made  to  determine  a  proper  choice  for  the  error  coefficient  models. 

Since  the  objective  of  this  report  is  to  provide  a  general 
ciata  reduction  algorithm  for  testing  an  Inertial  Navigation  System  on 
the  centrifuge,  a  general  statisUcal  model  was  selected  for  the  first 
60  states  shown  in  Table  4.1.  The  important  point  is  that  to  properly 
apply  the  data  reduction  alogorithm,  an  analysis  of  component  test 
aata  should  be  made  so  that  the  general  statistical  model  employed  in 
this  report  can  be  modified  to  represent  the  actual  platform 
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sensors  being  tested.  Sutherland  and  Gelb  [4]  found  that  a  random 
constant  in  combination  with  a  random  walk  provided  a  good  descrip¬ 
tion  of  gyro  drift  and  an  adequate  description  for  the  accelerometer 
terms.  A  random  constant  is  represented  by  the  following  stochastic 
differential  equation 

x(t)  =  0  (4.4) 

where  x(tQ)  is  a  random  variable.  A  random  walk  is  represented  by 

x(t)=w(t)  (4.5) 

where  w(t)  is  a  random  process  and  x(tQ)  =  0.  Combining  Eqs.  (4.4) 
and  (4.5),  the  statistical  model  assumed  for  the  first  60  states  is 
represented  by  the  following  scalar,  stochastic  differential  equation: 

x.(t)  =  w.(t)  [i  =  1,  2 . 60]  (4.6) 

where 

x.(to)  -  is  a  gaussian  random  variable  representing  the 

initial  value  of  the  ith  state  with  mean  x. (t  )  = 

.  l  o' 

x°5  =  E  |x.(to)j  and  variance  (rXoi  =  pQi  = 

E  -  *0i]2j 

E  {  }  -  is  the  expectation  operator 

(w.(t),  t  >  t  }  -  is  a  zero  mean,  gaussian  white  process 

(i.e.,  t ime  uncorrelated)  representing  the 
ith  state  disturbance  with  covariance 

cWi(t,  T)  =  E  |\v.(t)w.(T)}  =  <rw.  6(t  -  t) 
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6(1  -  t)  -  is  the  Dirac  delta  function 


E{[xi(to)  ’  X«i]  [WiU)]}  ° 


I  i .  e  .  ,  the  initial  state,  Xj(tD)  is 
independent  of  the  disturbance 
process  wj(t)] 


The  scalar  equitions  for  the  last  three  states  of  Table  4. 1 
(representing  the  Euler  anglet)  contain  the  system  dynamic  express¬ 
ions  of  Eq.  (4.3).  The  statistical  model  for  these  states  is  repre¬ 
sented  by  the  following  set  of  nonlinear,  stochastic  differential 
equations . 

*6i  (t)  =  [KpW  cos  [x63(t)]  +  Wzp(x)  sin  [x63(t)]}  / 
cos  [x62(t)lj  +  W6 1 (t) 

*62^)  {wZp(x)  cos  i x ^  3 ( t )  1  -  wxp(x)  sin  lx ( t)]  } 

+  w62(t)  (4.7) 

*63^*  =  [{uXp*x'  COE  sin 

+  w^p(x)  sin  [x63(t)]  sin  [x62<1)]}  / 

c°s  [x62(1)]  +  wyp(x)l  f  w63(t) 


where 


(Jj  (x ) ,  w  (x), 
xp  yp 


u  (x)  -  are  obtained  from  Eq.  (2.33)  with  the 

variables  of  Table  4.  1  replaced  by  their 

associated  state  variable  de signations 

(i .  e.  ,  x.  etc  .  ) 

r  A  1 
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*/i(t  ),  x,.,(l  ),  x ,  , (t  )  -  arc  uaussian  random  variables 
oi  o  be.  o  b)  n  . .  »  .  ...  ,  .  r 

representing  the  initial  values  of  the 

Kuler  angles  with  mean  x0  and 

2  ■* 

variance  (rXQj  U  -  61 . 62,  63) 

w6 1 w63(0  -  are  zero  mean,  gaussian  white  processes 

representing  the  jth  state  disturbance 


with  covariance  <r 
(j  =  61,62,  63) 


wi  ’  6<l  -  T> 


Wj(t)  and  xj(tQ)  are  independent 


Combining  Eqs.  (4.6)  and  (4.7)  gives  the  following  state  vector 
equation  for  the  calibration  program. 


h.  ~  —— ’  ^  +  w(t) 


(4.8) 


where 


x  -  is  a  63-element  vector  of  the  state  derivatives 

w(t)  -  is  a  63-elemcnt  disturbance  vector 

£(x,t)  -  is  a  63-dimensional  vector-valued,  nonlinear, 
function  of  the  state 


(w(t),  t  >  t  }  -  is  a  zero  mean,  gaussian  white,  vectoi  , 
disturbance  process 


E  jw(t)w  (t)|  =  Q(t)6(t-T) 

Q(t)  -  is  a  (63  X  63)  covariance  matrix  of  the 

2 

disturbance  process  containing  the  <rWj  elements 

E  (x(t  )}  =  x  -  is  a  63-element  mean  value  initial  state  vector 
containing  the  xD-  elements 


-  *Jfe(t0)  -  *o] 


T  | 


=  P 
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The  first  60  elements  of  £(x,t)  are  zero,  as  can  be  seen  from  Eq. 

(4.6);  the  last  3  elements  are  the  dynamic  expressions  on  the  right- 
hand  side  of  the  set  of  equations  given  in  Eq.  (4.7). 

It  is  important  to  understand  the  relationship  between  the 
selected  state  statistical  model  and  the  physical  parameters  of  the 
Inertial  Navigation  System.  The  first  60  initial  state  random 
elements,  x.  (t^) ,  usually  represent  the  variations  that  occur  in  the 
sensor  error  coefficients,  the  sensor  true  input  axis  location,  and 
the  sensor  torquer  scale  factor  between  the  time  that  the  sensor  is 
turned  off  and  the  time  it  is  turned  ba<  k  on.  Diene  random  changes 
in  the  values  of  the  sensor  variabh  n  between  turn  off  and  turn  on  are 
referred  to  as  the  sensor's  repeatability.  In  other  words,  it  has  been 
determined  from  sensor  tests  that  the  values  ol  the  error  coefficients, 
input  axis  misalignment  angles,  tnd  loruvn  r  hi  di  la.  tor  an  different 
each  time  the  sensor  is  activated.  An  analysis  ol  large  amounts  ol 
sensor  test  data  at  the  Holloman  fi  »  (lily  n  m  i|  i  that  this  lack  of 
repeatability  can  be  adequately  de»«  nbed  by  a  gaunaiun  probability 
law.  Once  the  sensor  is  operating,  random  i  hnnges  m  lh<  internal 
mechanism  of  the  sensor  and  the  sensor  feedback  loop,  which  arc 
believed  to  come  from  sourc  es  independent  of  those  causing  the 
repeatability  problem,  are  represented  by  the  gnussian  while 
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disturbance  process,  w(t).  The  assumption  of  a  gaussian  distribution 
for  the  random  operating  changes  is  again  based  on  an  analysis  of 
sensor  data.  The  assumptions  that  the  disturbance  is  white  (uncorre¬ 
lated  in  time)  and  independent  of  the  repeatability  sources  are  difficult 
to  justify  physically,  simply  because  not  enough  is  known  about  the 
complex  internal  and  external  mechanisms  that  generate  the  distur¬ 
bances.  This  is  one  subject  presently  under  technical  debate.  The 
importance  of  these  assumptions  will  be  shown  later.  This  is  one 
area  that  a  careful  analysis  of  the  sensor  data  should  be  made  to 
determine,  if  possible,  whether  the  statistical  model  as  proposed  is 
an  adequate  approximation  for  the  physical  sensors  being  tested.  For 
example,  if  the  disturbance  process  is  determined  to  be  time-corre¬ 
lated,  there  arc  techniques  discussed  by  Meditch  [16]  and  Ja/.winski 
[17]  that  resolve  the  problem  by  augmenting  the  state  vector.  Aug¬ 
menting  the  state  vector  (which  already  contains  63  elements),  for 
each  sensor  variable  found  to  have  a  time-correlated  disturbance, 
could  increase  the  complexity  of  the  problem  tremendously.  The 
questions  now  are  how  much  improvement  in  filter  performance  will 
be  obtained  and  does  the  improvement  warrant  the  increased  com¬ 
plexity  9  As  is  the  case  in  many  physical  problems,  a  simulation  may 
show  that  the  simpler  model  is  an  adequate  approximation  for  the  level 
of  accuracy  desired  in  the  state  estimates. 

In  the  calibration  problem,  the  first  60  initial  state  elements 
represent  a  slightly  different  initial  condition;  since  in  the  calibration 
procedure,  the  system  has  been  operating  for  quite  some  time  prior 
to  the  start  of  the  system  calibration  at  time  t  =  tQ.  For  instance,  in 
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the  centrifuge  test,  the  initial  condition  does  not  occur  until  the  cen¬ 
trifuge  is  stabilized  at  a  selected  g-level,  and  a  now  initial  condition 
is  established  for  each  additional  g-level  specified  as  part  of  the  total 
test  sequence.  Hence,  the  initial  condition  state  for  the  calibration 
problem  is  actually  a  combination  of  the  repeatability  effect  plus  the 
operating  disturbance  input  up  to  the  time  when  t  =  tQ.  Equation  (4. 6) 
shows  that  the  state  process  x(t)  is  a  linear  combination  of  two 
gaussian  variables.  Since  the  mean  value  of  w(t)  is  zero,  the  mean 
value  of  x(t)  at  any  point  in  time  will  be  equal  to  the  mean  value  gen¬ 
erated  by  the  repeatability  effect.  The  variance  of  x(t)  is  simply  the 
sum  of  the  variance  due  to  the  repeatability  effect  plus  the  operating 
disturbance,  since  the  variance  of  a  sum  of  two  independent  random 
variables  equals  the  sum  of  their  respective  variances  [18]. 


Consequently,  for  the  calibration  problem,  the  statistical  model  can 
represent  the  initial  condition  states  of  the  first  60  state  variables 
simply  by  adjusting  the  variance  to  include  the  input  disturbance  up  to 
the  time  when  t  =  tQ.  The  importance  of  the  independence  and  gaussian 
white  assumptions  can  now  be  realized,  since  correlation  in  the 
disturbance  process  or  between  the  two  variables  would  complicate 
the  modeling  effort. 

The  initial  value  of  the  last  three  Euler  states  described  in 
Eq.  (4.7)  represents  the  inne;  platform  misalignments  with  respect 
to  the  CRP  frame.  These  can  be  described  by  a  gaussian  distribution 
about  a  mean  initial  value,  since  the  normal  procedure  for  the  system 
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calibration  is  to  align  and  level  the  platform  via  a  standard  gyrocom¬ 
pass  technique  [2,  10],  The  mean  value  represents  the  nominal 
misalignments  that  occur  at  the  conclusion  ox  the  gyrocompass  pro¬ 
cedure,  and  the  variation  occurs  due  to  the  system  mechanisation 
uncertainties.  In  the  case  of  the  centrifuge  operating  test,  the  plat¬ 
form  alignment  is  maintained  and  reestablished  at  each  g-level  by 
caging  the  platform  gimbals  [10]  .  Caging  is  Xiccomplished  by  switching 
the  input  to  the  stabilisation  loops  from  the  gyros  to  the  gimbal  syn¬ 
chros  and  resolvers.  The  stabilization  loops  use  the  signals  from  the 
resolvers  to  drive  the  gimbals  until  the  synchros  reach  their  electrical 
null  positions,  which  correspond  roughly,  through  physical  alignment 
of  the  synchros,  to  an  alignment  with  the  platform  base  mounting 
frame.  The  mean  value  and  variations  occur  via  the  caging  procedure. 
The  operating  disturbance  represents  the  random  variations  associated 
with  the  noise  generated  over  the  small  operating  range  of  the  driver 
amplifiers  contained  in  the  stabilization  loops. 

Before  proceeding  to  the  measurement  equation,  one  final 
comment  is  required  concerning  the  formality  of  Eq.  (4.8).  In  Chapter 
3  of  Jazwinski  [  1  "7 ]  ,  an  outstanding  discussion  is  given,  showing  that, 
since  the  sample  functions  of  w(t)  are  a  function  of  the  Dirac  delta 
function  fi.  e.  ,  w(t)  is  delta-correlated],  w(t)  is  not  Riemann  intcgrable 
in  the  mean  square  sense.  Therefore,  Eq.  (4.8)  has  no  mathematical 
meaning  as  it  is  presently  defined,  since  the  equation  can  not  be 
integrated  to  obtain  a  solution  for  x(t).  However,  as  shown  by 
Jazwinski,  gaussian  white  noise  is  the  formal  derivative  of  independent 
Brownian  motions.  A  formal  representation  of  the  stochastic 


(4.10) 


differential  equation  in 


dx(t)  =_f(x,t)dt  +  d  _\(t) 


where 


J\(t),t  >  t  |  -  is  a  vector  process  of  independent  Brownian 
motions 

riie  first  term  on  the  right-hand  side  of  Eq.  (4.  10)  can  be  integrated 
ir  th <•  mean  square  sense  or  via  an  ordinary  integral  for  the  sample 
functions  of  x(t).  Integration  of  the  second  term  can  not  be  defined  for 
the  sample  functions  because  of  the  erratic  properties  of  Brownian 
motion.  However,  integration  of  the  second  term  has  been  defined  in 
a  mean  square  sense  by  Ito  and  is  called  the  Ito  stochastic  integral. 
Hence,  a  solution  of  x(t)  can  be  obtained  in  the  mean  square  sense  with 
the  formal  equation.  So  that  equations  that  contain  gaussian  white 
processes  are  integrable,  the  gaussian  white  process  is  always 
assumed  formally  related  to  the  independent  Brownian  motion  process 
|\(t),t>  t  |.  In  other  words,  \v(t)  is  formally  related  to  the  Brownian 
process  as: 


w (t ) 


d  X  ( t ) 
dt 


(4.11) 


The  measurement  equation  is  based  on  the  platform  acceleration 
model ,  Eq.  (2.34). 


V4 


h(x  ,  t )  4  m(t) 


(4.12) 


— i  n  n 


where 


a ind  "  is  a  3- element  indicated  acceleration  vector 

h(x,t)  -  is  a  3-dimensional  vector- valued,  nonlinear, 
function  of  the  state 

ni(t)  -  is  a  3-element  measurement  noise  vector 

The  function  h(x,  t)  is  obtained  from  Eq.  (2. 34)  with  the  variables  of 
Table  4.  1  replaced  by  their  associated  state  variable  designations. 

The  actual  INS  measurements  are  the  velocity  change  over  the  interval 
between  measurements.  A  first-order  approximation  of  the  vector 
velocity,  using  Eq.  (4.  12)  as  the  rate  of  change  in  velocity,  gives: 

_v(t  4-  At)  -  v(t)  Av  _h(x,t)At  +  nTj(t)At  (4.  13) 

where 

At  -  is  the  time  interval  between  measurements 

Av  -  is  the  3  element  vector  velocity  change  over  the 
measurement  interval 

Since  the  measurements  arc  obtained  at  discrete  time  points 

(t  ,  n  =  1, 2,3,,  .  .),  the  discrete  form  of  Eq.  (4.  1 3)  gives  the  final 

version  of  the  measurement  equation  for  the  calibration  problem. 

Av(t  )  =  h[  x(t  ),  t  ]  At  4-  m(t  )At  (4  .  14) 

—  n  —  —  nn  —  n 
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where 


At  -  is  the  time  between  the  (n-l)tli  and  nth  measurements, 

At  t  -  t  . 
n  n  - 1 

{ m(t  ),  n  1,2,3,,.  .  )  -  is  a  zero  moan,  gaussian  whit o , 

vector,  measurement  noise  sequence 

E  (m(t  )  At  }  =  O  for  ail  values  of  n  1,2,3 . since  m(t  ) 

is  a  zero  mean  sequence 


E  ]  m(t.)Atm  (t^)At|  =  (At)  R(t^ )6 fo r  all  j ,  n  1,2,3,... 


R(t  )  -  is  the  (3  X  3)  covariance  matrix  for  the  measurement 
n 

noise  sequence 


jn 


0  for  j  /  n 
1  fo  r  j  -  n 


is  the  Kronecker  delta 


E  jl  x(t  )  -  x  ]  ( m(t  )J  [  O  for  all  n  1,2,3,...  since  m(t  ) 


—  o 


is  assumed  independent  of  x(t  ) 


E  |[w(t.)][  m(t  )]  =  O  for  all  j,n  1,2,3,...  since  m(t  )i 


is 


assumed  independent  of  w(tj 


The  accelerometers  in  the  system  have  their  own  feedback  loops, 
referred  to  as  "capture  loops,"  since  they  "capture"  the  pendulous 
element  and  prevent  it  from  rotating  too  far  from  the  null  position. 

The  initial  state  and  state  disturbance  variations,  discussed  in  con¬ 
junction  with  the  state  equation,  are  generated  in  the  internal  mech¬ 
anisms  of  tli^‘  accelerometer  ami  its  capture  loop.  Tin*  output  of  the 
accelerometer  is  a  series  of  Av  pulses  that  are  processed  and  counted 
in  the  system  computer  circuitry.  The  measurement  noise  sequence 
is  related  to  the  electronic  noise  generated  in  the  system  processing 
loop  that  eventually  becomes  the  system  output  velocity  change. 
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Consequently,  the  assumption  that  the  noise  sequence  is  independent  of 
the  disturbance  and  initial  state  variations  is  justified,  since  there  is 
no  physical  dependence  between  the  gyro  and  accelerometer  circuitry 
and  the  system  output  processing  circuitry.  The  assumption  of  zero 
mean  gaussian  noise  is  based  on  an  analysis  of  system  output  data. 

The  assumption  of  while  noise  is  based  on  the  reasoning  that  there 
should  not  be  any  relationship  between  random  electronic  noise  and 
the  sequence  of  measurements  being  processed  through  the  circuitry. 

The  past  reference  to  the  measurement  "dynamic"  equations 
can  now  be  understood,  since  the  function  h(x,t)  contains  the  dynamics 
of  the  velocity  measurement  trajectory.  It  will  be  shown  in  the  next 
section,  that  the  rather  rough  first-order  approximation  used  to  obtain 
the  Av  form  of  the  measurement  equation  has  a  minimal  impact  on  the 
filtering  process  since  the  only  area  where  the  approximation  is  used 
is  in  the  computation  of  the:  filler  gain  matrix. 

With  the  state  and  measurement  equations  defined,  we  can  now 
proceed  to  develop  the  extended  Kalman  filter  equations  that  constitute 
the  filtering  algorithm,  which  in  turn  completes  the  requirements  for 
the  data  reduction  problem. 

4.4  EXTENDED  KALMAN  F1L  TER  EQUATIONS  AND 

FILTERING  ALGORITHM 

We  start  the  development  of  the  filter  equations  with  the  given 
nonlinear  state  equation,  which  is  repeated  below. 

x(t)  f(x,t)  +  \v(t)  (4.8) 
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Keeping  in  mind  that  the  following  equations  are  vector  expressions, 
we  will  drop  the  sub-bar  notation,  x,  as  a  matter  of  notational  conve¬ 
nience.  We  linearize  Eq.  (4.8)  about  a  reference  or  nominal  trajec¬ 
tory,  where  the  nominal  value  of  the  state  is  set  equal  to  the  filtered 
estimate.  The  filtered  estimate,  x(t|t),  is  defined  as  the  'best1' 
estimate  of  the  state  x(t)  based  on  measurements  taken  up  to  time  "t". 
In  the  case  of  a  linear  state  equation,  it  is  w’ell  know-n  [16]  that  the 
filtered  estimate  is  an  optimal  estimate,  since  the  Kalman  filter 
process,  which  generates  the  estimate,  minimizes  the  variance  of  the 
filtering  error.  The  filtering  error,  x(t|t),  is  the  difference  between 
the  true  value  of  the  state  and  the  filtered  estimate. 

x(t|t)  =  x  ( t )  -  x(t  1 1)  (4.15) 

In  the  case  of  a  nonlinear  state  equation,  the  filtered  estimate  is 
optimal  only  with  respect  to  the  linearized  equation.  Whether  the 
estimate  is  good  or  "best"  with  respect  to  the  nonlinear  state  equation 
depends  on  the  validity  of  the  linearization. 

The  reference  trajectory  is  a  deterministic  trajectory  obtained 

by  sotting  w(t)  to  zero  in  Eq.  (4.8)  and  the  nominal  value  of  the  slate, 

x  =x(t|t).  Therefore, 
nom  1 

f l  x(t  1 1),  l]  t  >  t  (4.  16) 

Gt  O 
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is  the  equation  of  the  reference  trajectory.  We  define  the  deviation 
from  the  reference  trajectory  as 


6x(t)  *  x (t )  -  x(t|t)  (4.  17) 

Comparing  Eqs.  (4.  15)  and  (4.  17),  we  see  that  the  deviation  is 
equivalent  to  the  filtering  error. 

Differentiating  Eq.  (4.17)  and  substituting  the  expressions 
contained  in  Eqs.  (4.8)  and  (4.  16)  gives 


=  f(x,t)  -  f[x(t(t),t]  +  w(t)  (4.18) 

If  the  deviations  from  the  reference  trajectory  are  small  so  that  the 
higher-order  terms  can  be  neglected,  a  Taylor  series  expansion  about 
the  nominal  filtered  estimate  gives 

f(x,t)  -  f[x(t|t),t]  ?Flx(t|t),t]6x(t)  (4.19) 

where 


F[x(t|t),t] 


A 


0h[x(t  |  t),t] 

8x. 

J 


i,j,  -  1,3,.. .,63 


is  a  (63  X  63)  matrix  of  partial  derivatives  of  the  elements  of  j_(x,t), 
evaluated  at  x(tlt),  with  respect  to  each  state  variable  Xj.  Substitutin 
the  approximation  of  Eq.  (4.  19)  into  Fq.  (4.  18),  we  obtain  a  linear 
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perturbation  equation  that  is  valid  for  "small"  deviations  about  the 
reference  trajectory. 


Flx(t|t),t]6x(t)  +  w(t)  (4.20) 

Since  the  measurements  are  discrete,  we  discretize  Eq.  (4.20) 
so  that  we  can  develop  the  filter  equations  using  the  discrete  form  of 
the  Kalman  filter.  It  is  a  personal  preference  to  compute  the  solution 
via  the  state  transition  matrix,  rather  than  solving  the  matrix  Riccati 
equation  to  obtain  the  filtering  error  covariance  matrix  as  required  in 
the  continuous  filter  procedure  [  1 6 ]  .  Therefore,  discretizing  and 
integrating  Eq.  (4.20)  over  the  time  interval  [t^  j,t^]  gives  the 
following  discrete  solution  to  the  perturbation  equation. 

6xttn)  --  4>[tn,tn_i;  x(tn.j|tn-1)]6x(tn-1)  +  D(tn_j)  (4.21) 


where 


D(tn-l'  -f  "  S(tn-ll‘n-ll)w(T)dT 

'l„.l 


<t>(t  ,t  4,xj  -  is  the  state  transition  matrix  \  1  f>] 
n  n- 1  11 

Tne  state  transition  matrix  is  obtained  by  solving  the  following 
matrix  differential  equation. 


I  ‘n-l'l  =  ‘Id'.  SO,,., 

(4.  it) 


t  <  t  <  t 
n- 1  n 
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The  initial  condition  for  the  matrix  differential  equation  is 


•  It  , ,  t  . ;  x(l 
1  n  - 1  n  - 1  ii-l 


IVi'l  1 


(•1.21) 


where 


I  —  is  a  (63  x  63)  identity  matrix 

The  relationship  between  Eqs.  ( 4 .  22)  and  (4.21)  should  be  clearly 
understood.  The  purpose  of  the  transition  matrix  is  to  transform  the 
perturbation  states,  6x(t  j),  along  the  reference  trajectory  from  time 
point  t^  j  to  time  point  t  Hence,  as  shown  by  Eq.  (4.23),  the  transi¬ 
tion  matrix  would  logically  be  the  identity  matrix  at  time  t  j .  In  the 
perturbation  solution  equation,  Eq.  (4.  21),  we  see  that  the  value  of  <t> 
is  at  the  final  time  t^,  since  getting  a  solution  requires  that  the  pre¬ 
vious  value  of  the  perturbation  states  6x(t  ^ )  be  transformed  along 
with  the  system  disturbance  to  the  solution  point  at  time  Trans¬ 

forming  the  perturbation  states  along  the  reference  trajectory  implies 
that  $  must  be  a  function  of  the  perturbation  dynamics;  Eq.  (4.  22) 
verifies  this  by  the  F  matrix  of  partials.  Equation  (4.  22)  represents 
the  set  of  dynamic  equations  that  permit  each  element  of  the  transition 
matrix  to  be  determined  at  any  time  t  over  the  closed  interval 
[  t^  j,  t  ]  .  Therefore,  Eq.  (4.22)  is  used  to  obtain  the  elements  of  <P, 
evaluated  at  time  t  ,  for  solving  Eq.  (4.  21). 

Solving  Eq.  (4.  22)  appears  to  be  a  formidable  task,  since  con¬ 
tains  3969  elements.  Fortunately,  this  is  not  the  case,  since  the 
maximum  number  of  differential  equations  will  be  18d.  The  reason  is 
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that  the  first  60  elements  of  £(x,  t)  are  zero;  therefore,  the  first 
60  rows  of  F  will  be  zero.  Assuming  each  element  of  the  last  three 
rows  of  F  will  contain  nonzero  partials,  the  maximum  number  of 
equations  would  be  3  times  63  or  189. 

It  will  be  shown  in  Section  6  that  the  reason  F,  and  therefore  4, 
is  a  function  of  time  is  due  to  the  applied  acceleration  being  a  function 
of  time  for  the  operating  centrifuge  test.  In  the  case  of  the  1-g  calibra¬ 
tion  in  the  local  gravitational  field,  the  F  matrix  is  constant  since  g  is 
constant.  Meditch  [16]  shows  that  for  a  constant  F  matrix,  4  can  be 
determined  using  the  matrix  exponential. 


4ft  ,  t  .  ;  x(t  .  |t  . )]  =  exp]lr(t  -  t  ,)[ 
L  n’  n- 1  'n-l'n-l'J  'n  n-lM 


Fm(t  -  t  .)‘ 

+ - + 


,  m 


I  +  F(t  -  t  .)  + 
'  n  n-  1 ' 


m  ! 


but  t  -  t  =  At,  so 
n  n  - 1 


n-  1 


x(t 


n-  1 


I  +  F  At  +  F 


2  (At)4 


Fm(At)m 
m  ! 


(4.  24) 

whore 


I  —  is  a  (63  X  o3)  identity  matrix 

F  =  F  [  x(t  ,  |  t  , )  ]  is  a  constant  matrix 
1  n-  1  1  n- 1  1 

X 

exp  x  f  ne  is  the  exponential  function 
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The  number  of  terms  in  the  4>  series  is  obviously  a  iunction  of 
the  time  between  measurements  At  and  the  desired  accuracy  of  <t>.  A 
computer  solution  of  Eq.  (4.  24)  is  definitely  computationally  more 
efficient  than  solving  the  set  of  differential  equations  of  Eq.  (4.  22)  for 
the  time-varying  <t>  case.  The  centrifuge  simulation  of  Section  6 
reveals  that  the  filtered  estimates  obtained  by  assuming  that  F  was 
constant  over  At,  and  thereby  permitting  Eq.  (4.  24)  to  be  used,  were 
just  as  good  as  those  obtained  by  determining  <t>  via  Eq.  (4.  22). 

The  disturbance  sequence  w(t^  j)  of  Eq.  (4.  21)  can  be  considered 
as  a  piecewise  constant  function  of  time  for  the  measurement  intervals 
(which  range  from  0.  02  to  1.0  second)  of  the  calibration  problem. 
Therefore,  the  D(tn  j)  term  can  be  simplified  to 

D(tn-1)  =  r^n,  ‘n-l  ’  x(tn-l  '  ln-l^  w(tn-l)  25) 

where  Fis  defined  as 


i 

rt>„.  Vl;  i(,n-l  =/  *l*n1  T;  K.-l)!  dl 


n-1 


(4.2b) 


Note  that  the  right-hand  side  of  Eq.  (4.  26)  reveals  that  we  need  to 

solve  for  $  from  t  back  to  t  .  .  In  other  words,  <i>  must  be  solved 

backward  in  time.  Hsu  and  Meyer  [  1?]  show  that  a  solution  of  4> 

backward  in  time  can  be  obtained  using  the  adjoint  system  equation. 

Hence,  4>  from  t  back  to  t  ,  is  obtained  from  the  following  adioint, 
n  n- 1 

matrix  differential  equation. 
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t,  x(t 


n- I  1  n- 1 


)  |  -  *[  I  ,  t,  x(t 


11-1 


I  )  |  F[  t,  x(t  , 
n-1  1  n-1 


ln-0  ^ 


The  initial  condition  for  the  adjoint  equation  is 


(4.  27) 


$[  tn>  t  ;  x(t^  j  j  t  j )  ]  =  I  (63  X  63)  identity  matrix 

(4.  28) 

With  $  (t  ,  t,  x)  determined  from  Eq.  (4.  27),  we  substitute  <t>  into 
Eq.  (4.  26)  to  get  F . 

Equation  (4.  27)  reveals  that  since  4>  premultiplies  F,  the  fact 
that  F  has  60  rows  of  zero  elements  does  not  help  reduce  the  number 
of  differential  equations.  Assuming  the  last  three  rows  of  F  contain 
nonzero  partials,  Eq.  (4.27)  will  generate  3969  equations.  Fortunately, 
the  assumption  that  F  is  constant  over  A  t  (based  on  the  centrifuge 
simulation  results  of  Section  6)  permits  F  to  be  determined  by  sub¬ 
stituting  the  exponential  series  of  <t>,  from  Eq.  (4.24),  into  Eq.  (4.26). 
The  substitution  results  in  the  following  series  expression  for  F,  when 
F  is  a  constant  matrix. 


r[t 


n 


n-1 


x(t 


n-  1 


Vl'J 


=  I  At  +  F 


(At)' 

2! 


,  .  .m+1 
rm  (At) 

+  F  T^+iTT  + 


(4.  29) 

The  discrete  solution  to  the  linear  perturbation  equation, 

Eq.  (4.  21),  can  now  be  written  as 


6x(t  )  =  4>[i  ,  t  ,  ;  x(t  t  )  )  6x(t  ,  )  +  r[  t  ,  t  ,  ;  x(t  ,  t  . )  ) 
n'  ln  n-1  'n-1  n-l  J  n-1  ln  n-1  n-1  n-l,J 


X  w(t  .) 
n-1 


(4.  30) 


where  x  represents  the  matrix  product  of  I  and  w. 
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We  now  develop  the  linear  perturbation  equation  for  the  nonlinear 


measurement  equation,  repeated  below. 

Av(tn)  =  h[  x(tn),  tn)  At  +  m(tn)  At  (4.  14) 


The  approach  is  similar  to  that  used  for  the  nonlinear  state  equation 

except  that  slight  modifications  must  be  made,  since  Eq.  (4.  14)  is  an 

approximation.  As  with  the  state  equation,  we  first  need  an  expression 

for  the  nominal  or  reference  measurement  trajectory.  Since  it  is  a 

deterministic  trajectory,  we  set  the  measurement  noise  sequence 

m(t  )  to  zero  and  select  a  nominal  value  for  the  state  x  (t  ). 
n  nom  '  n' 


A  v(t  )  =  h  [  x  (t  ) ,  t  ]  At 
n'  1  nom  '  n'  n 1 


(4.  31) 


The  question  now  is:  what  should  the  nominal  state  be  for  the 
reference  measurement  trajectory? 

To  help  answer  this  question,  let  us  regress  in  order  to  under¬ 
stand  the  selection  that  was  made  for  the  state  equation.  Expressing 
Eq.  (4.  16)  as  a  general  form  of  the  reference  state  trajectory  gives 


d  x  (t) 
nom 

dt 


=  U* _ (t),  t] 


nom 


(4.  32) 


Any  solution  to  the  nonlinear  differential  equation  could  be  used  as  a 
reference  trajectory.  In  the  rase  of  an  arbitrary  nonlinear  differential 
equation,  the  existence  and  uniqueness  of  solutions  remain  open 
questions.  When  the  structure  of  the  function  f[x(t),t]  satisfies  a 
Lipshitz  condition,  then  there  exists  a  unique  trajectory  through  each 
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point  in  state  spat  e.  Assume  thal  we  select  x  (t)  as  the  solution 
r  nom 

through  the  initial  a  priori  estimate  x(t()).  Then,  at  later  times  it 
is  possible  that  the  perturbations 

6x(t)  -  x(t)  -  x  (t)  (4.33) 

nom 

could  get  excessively  large.  Since  the  linearized  equations  that  form 

the  basis  for  the  Kalman  filtering  process  are  only  valid  for  small 

perturbations  about  the  xnorr)(^  wc  have  chosen,  the  filtering  process 

for  the  actual  system  would  be  at  best  inefficient,  assuming  it  was 

stable.  More  than  likely,  the  nonlinearities  that  were  negle  led  auring 

linearization  would  cause  the  filter  to  diverge. 

It  now  becomes  obvious  that  the  best  selection  would  be  to  base 

the  value  of  x  (t)  on  the  measurement  data;  so  that  the  reference 

trajectory  is  actually  being  constructed,  as  the  problem  develops, 

based  on  the  latest  measurement  information  available.  What  we  have 

just  described  is  the  estimate  produced  by  a  Kalman  filter.  The 

filtered  estimate  x(t  .  t  , )  is  the  "best"  estimate  of  the  state  at 

n- 1  n- 1 ' 

time  t  .  ,  based  on  measurements  taken  up  to  time  t  . . 
n-1  r  n-i 

In  the  case  of  the  measurement  equation,  Eq.  (4.  14),  we  see  that 

we  need  the  state  at  the  end  time,  t  ,  or  the  time  of  the  next  measare- 

n 

ment.  Hence,  we  need  to  project  our  best  knowledge  of  the  state 

forward  in  time.  The  best  "predicted"  estimate  would  be  the  value  of 

the  state  at  time  t  that  lies  on  the  reference  trajectory.  We  use  the 

state  reference  trajectory  equation,  Eq.  (4.32),  to  determine  the 

predicted  estimate  of  the  state  at  time  t  based  on  the  measurements 

n 


up  to  time  t  4 ;  in  other  words  ,x  (t)  =  x(t  It  4).  x(t  It  4)is 
r  n- 1  nom  n  1  n- 1  n  1  n- 1 

obtained  by  integrating  Eq.  (4. 32)  from  t  j  to  t^. 

x  t 

J  n  d  x(t  |tn  l)  =  y*  n  f[x(t|  tn  l),  t]  dt 

*n-  1  *n- 1 

The  solution  is  the  nominal  value  we  will  use  for  the  measurement 
equation. 


Xnom  =  x(tn^tn-i)  =  ^n-l^n-l*  +  f  Si-l*1  ^  dt 


(4.  34) 


Equation  (4.  34)  shows  that  the  predicted  state  estimate  is  obtained  by 
adding  the  integral  of  the  undisturbed,  nonlinear  state  equation  to  the 
filtered  estimate. 

Similarly,  the  best  predicted  measurement,  Av(tn|  t^  j),  can  be 
obtained  from  integrating  the  exact  nonlinear  measurement  equation, 
Eq.  (4.  12),  with  the  measurement  noise  set  to  zero  and  the  state  equal 
to  the  predicted  state  estimate. 


f  "  v  dt  =  r  nh[x(t  |tR  t),  t]  dt 

*n- 1  tjf., 
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Hence,  the  best  predicted  measuiement  is 


/tn 

h[x(t|  tn  l),  t]  dt  (4.35) 

ln-  1 

Note  again,  that  Eq.  (4.  35)  is  exact  and  not  an  approximation  of  the 
measurement  equation.  This  is  the  predicted  value  of  the  measurement 
that  will  be  used  in  the  extended  Kalman  filter  to  compare  with  the 
actual  measurements  from  the  Inertial  Navigation  System. 

Now,  for  the  perturbation  equation,  the  reference  measurement 
trajectory  is  the  approximation  given  by  Eq.  (4.  31).  The  predicted 
measurement  estimate  for  the  perturbation  equation  Av^  is  the  following 
approximation  with  the  nominal  value  of  the  state  equal  to  the  predicted 
state  estimate. 

Av  (t  |t  .)^h[x(t  |t  .),  t  ]  At  (4.36) 

p'n  n-1'  L  '  n  1  n-  1  ’  n  J 

The  deviation  from  the  reference  measurement  trajectory  is  defined  as 

6v(t  )  =  Av(t  )  -  Av  (t  |t  .  )  (4.  37) 

n  n'  p  n  n- 1  ' 

Substituting  Eqs.  (4.  14)  and  (4.  36)  into  Eq.  (4.  37)  gives 


6v(tn)  =  h[x(tn),  tn]  At  -  ln]  At  +  m^tn)  At 


If  the  deviations  from  the  reference  measurement  trajectory  are 
small,  so  that  the  higher-order  terms  can  be  neglected,  a  Taylor 
series  expansion  of  h(x,  t)  At  about  the  predicted  state  estimate  gives 


h[x(t  ),  t  ]  At  =  h[x(t  |t  ,),  t  ]  At 
1  '  n  nJ  1  '  n1  n  -  1"  nJ 


(4.  39) 


where 


H  [x(t  |t  t),  t  ]  = 
1  n1  n-1'  nJ 


3h.  [  x(t  it  . ) ,  t  ] 
1 1  '  n1  n-1"  nJ 


9x. 

J 


At 


i  =  1,2,3  j  *  1,2 . 63 


is  a  (3  X  63)  matrix  of  partial  derivatives  of  the  elements  of  h[x(tn),  t^]  , 
evaluated  at  x(tn|tn  l),  with  respect  to  each  state  variable  x^,  and 
finally  multiplied  by  At.  Now  Eq.  (4.  17)  evaluated  at  t  =  tR  and  with 
measurements  up  to  time  t^  j  gives 

6x<tn)  =  x<tn)  -  5(tn|  tn  l)  (4.  40) 


Substituting  Eqs.  (4.  40)  and  {4.  39)  into  Eq,  (4.  38)  gives  the  following 
discrete  solution  to  the  measurement  perturbation. 

6v(tn)  =  H[x(tnjtn  l),  ta  ]  6x(tn)  +  m(tn)  At  (4  41) 
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Equation,  (4.  30)  and  (4.  41)  give  ua  the  following  linearized 
discrete  system 

6x(,nl  ‘n-|iS<‘n.,l‘n.,>)  6*«„.,)+r[tn,  tn.,;S(tn.1|,n_1)] 

XW^n-l^  (4.42) 

6v(t„)  =  H[5(tnitn-i)'  ‘J  ^x(t„)  +  m(tn)  At 

with  the  following  stochastic  description 

k-  0,1,2,  ...|  -  is  a  zero  mean,  gaussian  white, 

vector,  disturbance  sequence 

E{w(,k>  wT<‘j>}  =  Q('k)  6jk  for  all  j.  k  *  0. 1 , 2  . . .  i.  the 

disturbance  covariance 

|m(tn)»  n  =  1 , 2,  3  ...  |  is  described  in  Eq.  (4.  14) 
w(tk)  and  m(tn)  are  independent  for  all  k  and  n 

F rom  Eq.  (4.  17),  with  t  =  t 


6x(to>  =x(to)  -x(to|to) 


(4.43) 


measurements,  it  is  well 


For  the  case  of  linear  dynamics  and  linear 
known  [It]  that  x„|„  i,  obtained  by  a  linear  operation  on  the  measure. 
me"tS'  and  iS  theref°'-'  «  gaussian  random  vector.  Also,  by  definition 


i(t0lt0)#E|x(to)|  exo 


(4.  44) 
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Since  x(t^)  is  gaussian  with  a  mean  value  of  x^,  Eqs.  (4.44)  and 
(4.43)  reveal  that  6x(t  )  19  gaussian  with  the  following  values  for  its 
mean  and  covariance. 


E|6x(t0)|  =  O 

e|6x(Io)  6xT(tQ)|  =  E{[x(t0)  -  x0][x(t0)  -  x0]T)  (4.45) 

=  Pq  [Reference  Eq.  (4.8)] 

Finally,  6x(tQ)  is  independent  of  w(tn_j)  and  m(t  )  f°r  values  of  n  . 

Equation  (4.42)  and  the  associated  stochastic  description  meet 
all  the  requirements  of  Theorem  5. 5  of  Meditch  [  1 6]  .  Therefore, 
the  theorem  shows  that  the  best  filtered  estimates  of  the  perturbation 
states  are  generated  by  the  linear  Kalman  filter, 

6i(tn^tn)  =  6*(tJln-l*  +  tn)  ^JVl^ 

(4.  46) 

where 


6x(t  1 1  , )  =  <X>[  t  ,  t  . ;  x(t  .  j  t  . )  ]  6x(t  .  1 1  . ) 

n1  n-1  1  n  n-1  n-11  n-1  1  n-11  n-1 

H(x,  t  )  =  H[x(t  |t  ,),  t  ] 

'  n  1  '  n1  n-1'  n 1 

A(t  )  -  is  the  Kalman  gain,  whose  equations  will  be  given  later 
n  in  the  text 


We  are  not  directly  interested  in  the  perturbation  states,  except 
for  the  equations  to  compute  the  Kalman  gain  A(tn),  which  will  be  given 
later.  We  are  interested  in  obtaining  an  expression  for  x(tn|tn).  If 
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we  take  the  conditional  expectation  of  Kq.  (4.  17),  with  respe<  t  to  the 

measurements  up  to  time  t  t  ,  and  let  the  state  be  at  time  t  =  t  ,  , 
r  n-1  n-1 


(4.  50) 


Substituting  Eqs.  (4.49)  and  (4.50)  into  Eq.  (4.48)  gives  an  expression 
for  the  "best"  estimate  of  the  state  at  time  t 

n 

=  S<‘A-1>  +  A<‘„>U*<tn>  -  A?(‘nl‘n.,)l  «■  51) 

where 

x(t  | t  )  -  is  the  filtered  estimate  at  time  tn  and  therefore 

provides  the  "best"  estimate  of  the  state  x(t  )  based  oi4 

measurements  taken  up  to  time  t  .  n 

n 

t 

i(tnl*n-l>  =  S(tn-l|‘n-t)  +  /  £tS<tltn-l)*  dl  ' 

ln-  1 

is  the  predicted  state  estimate  [Reference  Eq.  (4.34)] 
A(tn)  -  is  the  Kalman  filter  gain 
Av(tn)  -  is  the  actual  INS  velocity  measurements 

t 

Av(tnltn_i)  =  J  h[x(t|tn  l),  t]  dt  -  is  the  predicted 
ln  -  1 

measurement  [Reference  Eq.  (4,35)] 

[Av(tn)  -  Av(tn|tn_j)]  -  is  the  measurement  residual  mentioned 

at  the  beginning  of  Section  4 


The  equations  for  computing  the  Kalman  gain  A(tn)  are  also  from 
Theorem  5.  5  of  Meditch  [  16  ] 

A<tn>  =  «T[H  hT  *  R‘] ' ' 

P<tnl'n-I>  *  •P<,„-ll,n-!»  *T+  rQrT  I4-  52) 

p(‘n|tn)  *  [I  -  A(tn)  H]  P(tn|Vl)H  -  A(tn)  H]T  ♦  A(tn)  R*  AT(tn> 

v  he  re 


H  =  H[x(tnJtnl),  t^]  [  Reference  Eq.  (4.39)] 

R  =  (At)^  R(tn)  [Reference  Eq.  (4.  14)  ] 

ln- i  •  1 1  ln_  i)  ]  [  Reference  Eq.  (4.  22)  or  (4.  24)] 

r=r[tn,  tn  {  :  x(tn_i  |  *0-1)1  [Reference  Eq.  (4.  26)  or  (4.  29)] 
Q  =  Q(tn_j)  [Reference  Eq.  (4.42)] 

I  -  (63  X  63)  identity  matrix 


P,tn-li‘n-l)a"d  P<‘„|‘  n)  -  are  the  filtering  error  covariance 


matrices  at  time  t  .  and  t 
,  n- 1  n 

respectively 


^^nlSi-P  ”  *8  t*ie  Prediction  error  covariance  matrix 


6x(t  )  =  x(t  it  .)  =  x(t  )  -  x(t  1 1  ,)  is  the  prediction  error 

"  nln‘'  "  n|  [Reference  Eq.  (4.40)] 

6x(tn.,)  =  !?(tn.1|tn.l)  =  x(tn  l)  -  5<t  ,|t  ,)  is  the  filtering 

'  error  [  Reference 

Eq.  (4.17)] 
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Equation  (4.  51)  is  known  as  the  extended  Kalman  filter,  since  it 
applies  to  the  nonlinear  state  and  measurement  equations.  In  other 
words,  it  extends  the  filtering  process  beyond  the  linear  perturbation 
equations  of  Eq.  (4.42).  It  is  important  to  note,  however,  that  the 
Kalman  gain  is  based  on  the  linear  perturbation  equations.  Therefore, 
the  requirement  that  the  state  and  measurement  deviations  must  remain 
small  is  still  a  constraint  on  the  filtering  process.  This  can  be  seen 
in  the  second  term  of  Eq.  (4.  51).  The  second  term,  consisting  of  the 
Kalman  gain  multiplying  the  measurement  residual,  is  called  the 
correction  term,  since  it  corrects  the  predicted  estimate  xjt^lt^  j) 
based  on  the  measurement  data.  If  the  linearization  is  invalid,  the 
Kalman  gain  will  apply  an  "invalid"  correction  that  will  degrade  the 
filtered  estimate.  Note  that  the  approximation  of  the  av  equation, 

Eq.  (4.  13),  is  contained  only  in  the  Kalman  gain  computation,  as  was 
mentioned  in  Section  4.  3.  The  simulation  results  show  that  the  effect 
of  this  approximation  is  negligible,  as  long  as  At  is  maintained 
reasonably  small.  The  most  important  point  to  understand  is  that 
Eq.  (4.  51)  is  the  solution  to  the  calibration  problem.  It  formulates  the 
data  reduction  method  to  obtain  the  best  estimate  of  the  states  in 
Table  4.  1 .  A  schematic  of  the  extended  Kalman  filter  algorithm  is 
shown  in  Figure  4.  3.  The  algorithm  simply  implements  Eq.  (4.51). 

The  simulations  described  in  Sections  5  and  6  will  provide 
answers  to  most  of  the  questions  raised  in  this  section.  The  questions 
answered  by  the  simulations  are: 

(a)  Is  the  linearization  and  therefore  the  filtering  process 
valid  ? 
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(b)  Is  there  an  observability  problem,  and,  if  so,  can  the  data 
reduction  technique  resolve  it? 

(c)  Does  the  Av  approximation  prevent  filter  convergence? 

(d)  Can  the  computation  of  the  filter  be  simplified  by  assuming 
F[x,  t]  is  constant  over  the  measurement  interval,  and 
thereby  permit  4>  and  T  to  be  determined  by  the  simple 
power  series  forms  of  Eqs.  (4.24)  and  (4.  29)  respectively 9 

The  only  question  that  remains  is  the  impact  on  the  assumed  statistical 
model  if  the  disturbance  process  is  found  to  be  correlated.  Bucy  and 
Joseph  [20]  show  that  correlated  noise  can  be  approximated  quite  well 
by  uncorrelated  noise  having  the  same  ow  frequency  spectral  density 
as  the  correlated  process.  They  claim  that  the  approximation  is  valid, 
provided  that  the  time  constant  of  the  noise  is  small  with  respect  to  the 
total  filtering  time.  In  those  cases  where  a  correlated  model  was 
assumed  for  gyro  drift,  the  time  constant  was  specified  to  be  in  a 
range  of  20  to  50  seconds.  Sections  5  and  6  will  show  that  the  total 
filtering  time  will  be  10  to  15  minutes  per  g-level  for  the  centrifuge 
calibration  and  2  to  3  hours  for  the  1-g  calibration.  Therefore,  the 
assumed  statistical  model  with  the  adjusted  variance  proposed  by  Bucy 
and  Joseph  may  be  an  excellent  alternative  to  augmenting  the  state 
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SECTION  s 


SIMULATION  OF  A  Up  CALIBRATION 

A  centrifuge  test  program  normally  consists  of  a  1-g  calibration 
in  the  local  gravitational  field  prior  to  and  immediately  following  the 
operating  centrifuge  test.  The  purpose  of  this  test  is  to  determine 
the  overall  effect  of  the  centrifuge  environment  on  the  fixed  and  first- 
order  error  coefficients.  The  results  of  a  17-state  simulation,  using 
the  same  techniques  proposed  for  the  operating  centrifuge  test,  are 
contained  in  this  section.  Measurement  data  was  generated  by 
simulating  the  platform  motion  due  to  error  drift,  earth- rate  input, 
and  a  prespecified  command-torquing  profile.  The  measurement 
data  was  input  to  the  extended  Kalman  filter  algorithm,  defined  in 
Section  4,  to  obtain  estimates  of  14  inertial  sensor  parameters  and 
the  three  Euler  angle  states  used  to  track  the  platform  motion.  The 
simulations  described  here  and  in  Section  6  were  developed  and 
operated,  over  a  6- month  time  period,  on  a  Control  Data  Corporation 
7600  scientific  computer  located  at  The  Aerospace  Corporation, 

El  Segundo,  California. 

5.  1  SIMULATION  STATES  AND  EQUATIONS 

Since  the  applied  acceleration  is  limited  to  1  g,  only  the  fixed 
and  first-order  sensor  coefficients  contribute  significantly  to  the 
gyro  drift  and  accelerometer  output  uncertainty.  As  will  be  shown 

in  Section  6,  the  higher-order  accelerometer  coefficients  range  from 

2  3 

5  to  12  fig/ g  for  the  second-order  terms  and  3  ug/g  for  the  third- 

order  terms,  where  1  pg  -  1  X  10  ^  g's.  The  gyro  higher-order 

Preceding  page  blank 
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2 

compliance  terms  range  from  3  to  4  ineru/g  ,  where  a  meru  is  a  rate 
unit  defined  by 

1  earth  -  rate- unit  (eru)  =  7.292116  X  10-J  rad/sec  «  15  deg/hour 

-  3 

1  milli- earth- rate  unit  (meru)  =  10  eru 

and  is  obviously  based  on  the  earth's  rotational  speed 

The  14  sensor  parameters  and  three  Euler  angles  are  defined 
in  Table  5.  1.  All  the  fixed  and  first-order  accelerometer  terms 
normally  considered  in  a  platform  calibration  have  been  included.  In 
the  case  of  the  gyro,  the  mass  unbalance  was  limited  to  the  input  axis 
term.  One  misalignment  angle  for  each  type  of  sensor  was  included 
to  evaluate  the  ability  of  the  filtering  process  to  estimate  sensor 
misalignments.  Since  the  purpose  of  the  simulation  was  to  validate 
the  data  reduction  method,  a  sufficient  number  of  states  were  included 
to  represent  all  the  basic  types  of  fixed  and  irst-order  terms  usually 
determined  from  a  physical  calibration  process;  however,  the  total 
number  of  states  was  limited  to  keep  the  complex  task  of  structuring 
and  analyzing  the  filter  tractable. 

Prior  to  an  Inertial  Navigation  System  test,  a  sequence  of  com¬ 
ponent  tests  is  performed  during  the  development  phase  of  the  plat¬ 
form.  This  implies  that  the  basic  structure  of  the  sensor  models 
should  be  fairly  well  defined  before  the  platform  tests  are  conducted. 
Since  one  of  the  main  purposes  of  the  simulation  was  to  validate  the 
linearization  and  determine  the  effect  of  the  Av  approximation  con¬ 
tained  in  the  <t>  and  H  terms  of  the  gair.  computation,  Eq.  (4.52),  no 
additional  modeling  errors  were  considered  elsewnere  in  the  liter. 
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In  other  words,  it  was  assumed  that  the  model  used  to  generate  the 
measurement  data  and  the  model  contained  in  the  state  and  measure¬ 
ment  dynamics  of  the  predicted  filter  loops  (reference  Figure  4.3) 
were  identical.  This  does  not  imply  that  model  inaccuracies  will  not 
exist  in  the  physical  application  of  the  algorithm.  In  fact,  as  dis¬ 
cussed  by  Jazwinski  in  Chapters  7  through  10  of  Reference  [  1 7 ]  , 
model  inaccuracies  can  cause  serious  degradation  or  divergence  of 
the  filtering  process.  An  example  of  the  degradation  caused  by 
including  the  Av  approximation  in  the  measurement  prediction  loop, 
rather  than  the  gain  computation,  is  shown  in  the  simulation  results. 
However,  additional  investigations  of  the  effects  of  modeling  error 
are  recommended  for  future  study. 

Two  additional  simplifying  assumptions  were  made  with  respect 
to  the  platform  rate  equation,  Eq.  (2.33).  The  internal  gyro  torquer 
scale  factors  were  assumed  to  be  unity,  to  limit  the  number  of  states 
in  the  simulation,  and,  finally,  the  servo  error  term  was  assumed  to 
be  zero.  The  servo  error  term  is  considered  to  be  a  deterministic 
quantity,  whose  value  is  obtained  from  a  servo  analysis  and  test  of 
the  platform  stabilization  loop. 

The  simulation  equations  are  obtained  from  a  combination  of 
Eqs.  (3.25),  (2.33),  and  (2.  34).  Section  B.  1  of  Appendix  B  shows 
that  the  contribution  of  the  Group  2  terms  of  Eq.  (3.25)  can  be 
neglected,  and,  since  the  centrifuge  is  nonoperating  for  the  1-g 
calibration,  the  applied  acceleration  equation  reduces  to 

AS  CsCPGe  (5.1) 

is  p  r 
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where 


-  is  the  Euler  transformation  matrix  given  by  Lq.  (4.  1) 

C8  -  is  obtained  from  Eqs.  (3.  19)  and  (3.20)  with  the  rnis- 
P  alignment  angles  defined  in  Table  5.  1 

Ge  -  is  defined  by  Eq.  (3. 25)  with  g  =  1 


Equation  (5.  1)  gives  the  acceleration  applied  to  each  gyro,  which  is 
used,  along  with  the  states  designated  in  Tible  5.  1,  to  obtain  the 
following  set  of  platform  rate  equations  from  Eq.  (2.33): 


where 


u  =  -  x .  -  x.  E .  -  +  x.  x  4  ,  E,  ,  -  TGX 

xp  1  4  13  4  13  33 


-  E12  WEC  -  En  WES 


cjyp  =  -x2  -  x5  E23  -  TGY  -  E22  WEC  -  E23  WES  (5.  2) 


"zp  =X1  x13  +X13  x4  E13  +x13  TGX  -  x3 


'x6  E33  "  TGZ  "  E32  WEC  ’  E33  WES 


E1 2 

=  cxl7 

SX16 

CX  j 

5 

+  sx17 

sx  1 5 

E1 3 

=  cx1? 

SX16 

SX| 

5 

"  SX 17 

cx  1  5 

E22 

=  cx16 

cx15 

• 

E23 

=  CX16 

SX1 5 

E32 

=  sx1? 

sx16 

CX  J 

5 

’  CX 17 

sx  1  5 

[Reference  Eq.  (4.  I )] 
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L33  “  sx  17  sx16  sx  1 5  f  CX17  cx15 

WEC,  WES  -  are  the  earth  rate  components  defined  r;  Eq.  (3.3) 
and  represented  in  ox  r  [Sec  Eq.  (3.17)] 

TGX,  TGY,  TGZ  -  are  the  gyro  command  torque  values  of 

Eq.  (2.33) 

With  the  platform  rates  defined  by  Eq.  (5.2),  we  can  define  the 
state  vector  equation  directly  from  Eq.  (4.8). 

x  =  f(x)  +  w(t)  (5.3) 


where 


x  and  \v  are  17 -element  vectors 

_f(x)  -  is  a  17-dirnensional  vector- valued  function 

The  only  difference  between  Eq.  (5.3)  and  Eq.  (4.8)  is  the  dimen¬ 
sionality  of  the  equation  and  the  fact  that  f_  is  not  an  explicit  function 
of  time.  We  know  from  Section  4  that  the  first  14  elements  of_f  are 
zero,  and  the  last  three  elements  contain  the  dynamics  of  the  system 
platform  rates. 


f4c  =  (u,  cos  x..,  +  u>  sin  x,-)/cos  x,/ 
15  xp  17  zp  If  16 


16 


zp 


; ,  -  w  s  in  x ,  n 

If  xp  17 


(5.4) 


f17  =  (wxp  COS  x17  sin  x  1 6  +  wzp  bin  x17  sin  xl6^c os  X16  T 


yp 
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The  statistical  description  of  Eq.  (5. 3)  is  identical  to  Eq.  (4.  8)  with 
the  dimensionality  adjusted  from  63  to  17. 

The  measurement  equation  is  obtained  in  a  similar  manner  as 
the  state  equation.  Starting  with  Eq.  (5.1),  we  obtain  the  acceleration 
applied  to  each  accelerometer,  which  is  used  in  conjunction  with  the 
states  designated  in  Table  5.  1  to  obtain  the  following  set  of  equations 
for  the  elements  of  h[x(tn)]  from  Eq.  (2.34): 


hl  "  X7(tn)  +  X10(tn)  E13(tn)  "  x10(tn)  x14(tn)  E23(tn) 

h2  =  x8(tn>  +  xll<tn>  E23(tn>  (5’5) 

h3  =  x9(tn)  +  x12(tn)  E33(tn) 


The  measurement  equation  is  identical  to  Eq.  (4.  14)  with  h[x(tn>] 
defined  by  Eq.  (5.5).  Note  that  h  is  not  an  explicit  function  of  time 


5.2  MEASUREMENT  SIMULATION 

This  section  contains  a  description  of  the  part  of  the  simulation 
program  that  generated  the  measurement  data.  Table  5.2  contains  a 
list  of  the  mean  values  xn.,  and  standard  deviations  <rv  ,  used  in  the 

Uj  x0. 

gaussian  subroutine  program  to  formulate  the  initial  state  vector 
x(tQ).  Since  the  simulation  values  are  considered  the  true  state 
values,  we  will  define  x(t)  to  be 


—true  — sim 


(5.6) 
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The  mean  values  are  representative  of  the  sensor  coefficients  and 
misalignment  magnitudes  obtained  from  actual  calibrations  performed 
on  the  Carousel  VB  Inertial  Measurement  Unit.  The  standard  devi¬ 
ations  were  chosen  to  be  representative  of  the  Carousel  VB  1-s  gma 
error  budget  [10]  given  in  Table  5.3.  The  error  budget  represents 
measured  uncertainty  from  a  combination  of  sensor  and  platform 
calibration  data  taken  over  90-day  intervals.  Since  the  error  budget 
uncertainty  represents  changes  from  the  last  calibration,  in  addition 
to  calibration  uncertainties,  both  the  repeatability  effect  and  operating 
random  changes  discussed  in  Section  4.  3  of  Section  4  are  included  in 
the  error  budget.  Comparing  Tables  5.  2  and  5.3,  we  see  that  the 
major  portion  of  the  error  budget  was  included  in  the  initial  state 
deviations,  which  represent  the  lack  of  repeatability  from  turn-off  to 
turn-on,  plus  the  operating  disturbance  input  up  to  the  start  of  the 
calibration  at  t  =  tQ,  as  described  in  Section  4.3,  From  experience, 
the  repeatability  effect  is  usually  the  major  portion  of  the  error  budget. 
It  should  be  noted  that  the  mean  value  of  the  Euler  angles  represents 


the  initial  alignment  error  of  the  platform  with  respect  to  (east,  north, 

up);  this  corresponds  to  the  (x  ,  y  ,  z  )  platform  axes,  which,  in  turn, 

P  P  P 

correspond  to  the  (a,  \,  (3)  Euler  angles.  The  Euler  angle  standard 
deviation,  in  conjunction  with  the  disturbance  process  deviation,  to  be 


given  later,  represents  the  uncertainty  associated  with  the  platform 


stabilization  loop. 


Table  5.4  contains  a  list  of  the  standard  deviations  for  the 


zero  mean,  gaussian  white,  disturbance  process  w(t)  of  Eq.  (4.8)  and 
the  zero  mean,  gaussian  white,  measurement  noise  sequence  rr,_( )  of 
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Eq .  (4.  14).  From  tost  experience,  a  good  approximation  of  the 
magnitude  of  the  operating  random  uncertainty  in  sensor  parameters 
is  10  percent  of  the  repeatability  uncertainty.  Therefore,  the  values 
of  crWj  through  crWj^  arc  ^  percent  of  the  associated  <rx.  given  in 
Table  5.  2.  The  deviations  associated  with  the  Euler  angle  distur¬ 
bances  (wj^  thru  were  set  equal  to  the  initial  state  deviation 

values  (cr^,.  thru<rx^),  since  they  are  both  associated  with  the 
stabilization  loop  uncertainty.  The  Carousel  VB  error  budget  distur¬ 
bance  represents  the  measured  uncertainty  over  a  24-  to  48-hour 
continuous  test  program.  The  assumption  made  for  the  simulation 
was  that  the  disturbance  represents  the  uncertainty  over  the  cali¬ 
bration  test  time,  which  is  established  by  the  length  of  time  the 
command  torquing  is  applied.  The  prespecified  command  torque 
profile  time  was  3  hours  and  30  minutes  or  13,  140  seconds.  Since 
the  measurements  were  generated  at  discrete  time  points,  t^,  the 
disturbance  added  each  At  measurement  cycle  was  obtained  by  scaling 
the  total  disturbance  standard  deviation  by 

<Twj  =  A<rw.  i  1,2,...,  17  (5.7) 


where 


tr^,.  -  is  the  standard  deviation  of  the  disturbance  added 
each  measurement  cycle 

k  =  At/13140 

<rw  -  is  the  total  disturbam  o  deviation  and  are  the  values 
3  listed  in  Table  5.4 


Equation  (5.7)  holds,  since  w(t)  is  gaussian  v/hite  and  therefore  time 
independent.  Independence  implies  Hint  the  sum  of  the  variances  of 
each  measurement  cycle  equals  the  total  disturbance  variance.  The 
number  of  measurement  cycles  is  13140/At  or  1/k.  Therefore, 


k 


+ 


+  . 


terms ) 


(5.8) 


and  Eq.  (5.7)  follows.  The  equations  of  the  first  14  sensor  para¬ 
meters  are  in  discrete  form  in  the  measurement  simulation  and  are 

represented  by  the  following  example  of  the  first  parameter  Drv. 

r  A 


DFX(V  -  DFX(tn-l)  + 
n  1,2,3 _ 13141 


(5.9) 


where  w'(t  )  -  is  the  scaled  disturbance, 
l  n 

For  the  Euler  angles,  the  disturbance  is  added  after  the  dynamic 
equations  of  Eq.  (5.4)  are  integrated.  For  example, 

»(t>  =  *'(t  )  +w'(t  )  (5.10) 

n  n  Inn 


where 


</'(t  )  =  Of( t 
n 


n-1 


) 


[Reference  Eq.  (5.4)] 
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w'  (t  )  -  is  the  sealed  disturbance 
l  o  n 

The  measurement  noise  is  based  on  the  fact  that  the  output  of 
the  accelerometers  is  a  series  of  Av  pulses  that  arc  counted  by  the 
platform  computer  over  each  measurement  cycle.  The  pulse  weight 
for  the  Carousel  VB  is  0.002569  ft /sec  /  pulse  .  Converting  this  value 
to  local  gravity  units  gives  a  pulse  weight  of  80.28  pg- sec /pulse, 
where  g  32.  124  fl/sec^.  The  total  Av  for  a  measurement  cycle  will 
be  some  integral  number  of  pulses  plus  some  residual  value  of 
velocity.  If  the  residual  value  is  greater  than  1/2  of  a  pulse  (i.  e.  , 
greater  than  40.  14  pg-sec),  then  another  pulse  will  be  generated. 

If  the  residual  is  less  than  40.  14  pg-sec,  then  no  pulse  will  be  added. 
Therefore,  the  error  in  Av  will  be  somewhere  in  the  range  of  0  to 
40.  14  pg-sec.  The  assumption  is  that  the  maximum  error  of  40.14 
pg-sec  is  a  3-sigma  value;  hence,  a  1-sigma  deviation  for  each 
measurement  cycle  would  be  13  pg-sec,  which  is  the  value  shown  in 
Table  5.4.  Note  that,  since  the  uncertainty  in  Av  occurs  each  cycle, 
there  is  no  scaling  of  the  measurement  noise.  The  discrete  form  of 
the  measurement  equation  used  in  the  measurement  simulation  is 

Av(t  )  =  Av'(t  )  t  m(t  )  (5.  t  1) 

—  n  —  n  —  n 


where 


Av'(tn) 


t 

n 


n-  1 


1  32 


hdt 


h  -  is  defined  by  Eq.  (5.5) 


We  now  see  that  the  units  given  in  Table  5.4  are  compatible  with  the 
measurement  simulation  discrete  equations. 

After  some  preliminary  runs  of  the  simulation,  a  measurement 
cycle  of  At  =  1 . 0  second  was  selected  in  conjunction  with  an  integration 
step-size  of  0.25  second.  The  method  of  integrating  the  state  and 
measurement  dynamics  was  4th-order  Runge-Kutta.  It  was  found 
that  increasing  At  degraded  the  Euler  angle  estimates,  and  decreasing 
it  showed  little  improvement  compared  to  the  increase  in  measure- 

_  4 

ment  processing.  Rased  on  a  nomin  il  platform  rate  of  4.7  X  10 
rad/sec  (see  Section  B.  1  of  Appendix  B)  implies  that  measurements 
were  taken  every  1.62  arc-minutes  of  platform  angle. 

Figure  5.  1  contains  a  flow  diagram  of  the  measurement  simu¬ 
lation  program.  Block  1A  sets  up  the  initial  state  vector  x(tQ)  for 
the  measurement  simulation  using  the  values  of  Table  5.2.  The  filter 
initial  conditions  broi  ght  in  at  Connector  3  are  covered  in  the  next 
section.  The  do-loop  to  Statement  499,  located  at  the  end  of  the  flow 
diagram,  is  the  major  simulation  loop  that  establishes  the  number  of 
measurements  N  the  filter  will  process.  The  first  measurement 
occurs  at  time  tj,  where  tj  -  t  -At  =  1.0  second,  implying  that  zero 
measurements  will  be  processed  when  M  =  1  and  13,  140  will  be 
processed  when  M  =  13,141.  Therefore,  the  maximum  value  of  M 
permits  the  filter  to  process  measurements  over  the  entire  torque 
profile  time  of  13,140  seconds.  The  results  will  show  that  filter 
convergence  was  occurring  around  6200  cycles.  The  command  torque 
generation  block  is  given  in  detail  in  Figure  5.2.  Initially,  the 
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Figure  5.1.  Flow  ^Diagram  of  Measurement  Simulation  Program 


1  34 


RETURN  TO 
MEASUREMENT 
SIMULATION  LOOP 


command  torque*  profile;  consisteel  of  a  sequence  of  maneuvers  that 
placed  each  axis  of  the  platform  either  vertically  up  or  down,  so  that 
the  maximum  1-g  acceleration  would  be  applied  to  each  sensor.  The 
torquing  sequence  required  13,  140  seconds  to  complete  the  total 
profile.  Since  the  filter  was  converging  in  less  than  one-half  the 
torque  profile  time,  the  profile  was  modified  to  see  the  effect  of 
applying  a  step-type  torque  program  prior  to  filter  convergence. 
Figure  5.2  shows  the  final  form  of  the  torque  program.  It  should  be 
understood  that  no  attempt  was  made  to  optimize  the  torque  program 
with  respect  to  filter  performance.  Optimization  of  the  torque  pro¬ 
file  will  be  discussed  in  Section  7  and  is  recommended  for  future 
study.  Maximum  command  torquing  of  platforms  r  ages  from  6  to 
10  eru  (earth- rate-units) ,  since  the  basic  use  is  to  provide  precise 
torquing  during  gyrocompass  alignment  procedures.  In  the  case  of 
the  Carousel  VB,  the  maximum  command  torque  rate  is  6  eru. 


Neglecting  platform  motion  due  to  error  drift  and  earth  rate  input, 
the  first  loop  (N  S  2600  with  At  =  1 )  applies  6  eru  along  the  negative 


Xp  and  y^  axes  [note  the  sign  convention  of  Eq .  (5.2)]  ,  which  drives 
the  platform  from  the  initial  (east,  north,  up)  alignment  to  an 


orientation  where  the  z  axis  is  horizontal,  the  x  axis  is  45  deg 

P  P  h 

above  the  horizontal,  and  the  y  axis  is  45  deg  below  the  horizontal. 

P 

The  second  loop,  2600  <  N  i  4400,  applies  6  eru  along  the  positive 


Zp  axis  to  drive  the  y^  axis  to  a  position  of  vertically  down.  The 
remaining  loops  maintain  6  eru  along  the  positive  z^  axis  and  step 
1  eru  of  torque  rate  into  both  the  negative  and  y^  axes  every  100 
cycles,  until  a  maximum  of  6  eru  is  applied.  The  maximum  torquing 
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along  the  three  axes  is  maintained  for  the  remaining  measurement 
cycles . 

Block  2  generates  w(t)  anti  m_(t)  using  the  values  in  Table  5.4. 
Block  3  formulates  the  sensor  parameter  equations  represented  by 
Eq.  (5.  9).  Blocks  4  and  5  arc  4th-order  Runge-Kutta  integration  of 
Eqs.  (5.4)  and  (5.5),  respectively.  As  mentioned  previously,  the 
integration  step- size  was  0.  25  second,  implying  that  J  =  4  in  the 
integration  do-loop.  Block  6  formulates  the  Euler  angle  and  Av 
equations  represented  by  Eqs.  (5.10)  and  (5.11),  respectively.  The 
check  for  3  within  bounds  stops  the  simulation  if  (3  is  approaching  the 
singularity  condition.  The  filter  is  first  entered  at  Connector  1.  The 
Av  measurements  are  input  to  the  filter  algorithm  at  Connector  2. 

The  return  from  the  filter  for  the  next  measurement  data  cycle  is 
accomplished  at  Connector  4.  Statement  49T  completes  the  major 
do-loop  cycle.  The  iterations  are  complete  when  N  equals  the  preset 
M  value. 

5.3  FILTER  ALGORITHM 

A  flow  diagram  of  the  filter  algorithm  is  contained  in  Figure  5. 3. 

The  filter  equations  of  Section  4  are  reformulated  into  a  function  of 

the  measurement  cycle  variable  N;  where  the  Nth  cycle  occurs  at 

time  t  ,  the  N-lst  cycle  occurs  at  time  t  .  and  t  -t  «  =  At  =  1 
n’  ’  n- 1  n  n-  1 

\ 

second. 

Define 

x(N-  1 )  =  x(t  .It.  . )  ( 17  X  1 )  filtered  state  vector  at  time  t  . 

n-  1  1  n-  1  n-  1 

x(N)  =  x(t  It  )  (17  X  1)  filtered  state  vector  at  time  t 
'  n 1  n  n 
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BLOCK  1  B 


Flow  Diagram  of  Filter  Algorithm 


1  3,S 


Figure  5.  3, 


x  (N)  x(t  It  , )  (17  ■  1)  predicted  state  vector 
n  '  n-  I  1 

Av(N)  -  (3X1)  measurement  data  vector  from  measurement 
simulation  program 

Av(N)  -  (3X1)  predicted  measurement  vector 
A(N)  -  (17  X  3)  Kalman  gain  matrix 

F(N-l)  =  F[x(t  j|tn  ^ )]  (17  y  17)  matrix  of  state  dynamic 
n~  "  partials 

H(N)  =  H[x(t  It  ,)]  (3  X  17)  matrix  of  measurement  dynamic 
n  n  partials 

$(N,  N-  1 )  =  ®,[tn,  t  jl  x(tn_  j  1 1  j)]  ( 17  X  17)  state  transition 

matrix 

T(N,  N-  1 )  =  r(t  ,  t  . ;  x(t  .  1 1  . )]  (17X17)  disturbance 

*  1  n  n- 1  n-11  n- 1 

transition  matrix 

P(N-l)=P(t  ,|t  . )( 17  X  1 7 )  filtering  error  covariance  matrix 

n- l '  n- 1  ,  , .  ” 

at  time  t  4 
n-  1 

P(N)  =  P(t  |t  )  (17  x  17)  filtering  error  covariance  matrix  at 
n  n  time  t 

n 

P(N)  =  P(tn|tn  j)  (17  X  17)  prediction  error  covariance  matrix 
Q(N-l)  -  given  (17  X  17)  disturbance  covariance  matrix 

>Jc 

R  (N)  -  given  (3  X  3)  measurement  error  covariance  matrix 
x0  -  given  mean  value  initial  state  vector  (17  X  1) 

Po  -  given  initial  state  covariance  matrix  (17  X  17) 

Block  1  B  of  Figure  5.3  establishes  the  initial  conditions  for  the 
filter.  The  initial  filtered  estimate  is  x(0)  E  x0.  Since  we  assume 
that  we  do  not  know  the  moan  vaiue  of  the  initial  state  vector,  xD 
represents  our  "best  guess".  How  far  off  the  "best  guess"  can  be 
from  the  true  mean  value  (given  in  Table  5.2)  and  still  have  the  filter 
converge  to  its  steady-state  condition,  indicates  the  stability  of  the 
calibration  filtering  process  with  respect  to  the  initial  state  condition. 
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A  number  of  values  of  xD  were  used  in  the  simulation  and  are  given  in 
the  next  section.  The  initial  value  of  the  filtering  error  covariance 
matrix  is  P ( 0 )  E  PQ.  PQ  is  the  initial  state  covariance  matrix  defined 
in  Eq.  (4.8).  Again  we  assume  we  do  not  know  PG.  Examining  Eq. 
(4.52)  shows  that,  since  Q  is  usually  much  smaller  than  P,  P  is  the 
predominate  factor  in  determining  the  initial  gain  of  the  filter.  If 
P(0)  is  too  large,  then  the  gain  level  is  placing  too  much  weight  on  the 
initial  "poor"  estimates.  This  causes  the  filter  to  operate  inefficiently. 
If  P(0)  is  too  small  and  the  initial  state  uncertainty  is  large,  then  there 
is  insufficient  gain  to  make  the  necessary  corrections  which  can  cause 
the  filter  to  diverge,  since  the  linearization  is  no  longer  valid.  In  the 
case  of  Q,  Eq.  (4.52)  shows  that,  when  the  filter  is  near  convergence 
and,  therefore,  P  is  close  to  zero  (since  the  Kalman  filter  is  a 
minimum  variance  filter),  Q  becomes  the  predominate  factor  in 
determining  the  filter  gain.  If  Q  is  too  small,  then  the  gain  is  essen¬ 
tially  zero,  and  this,  in  effect,  decouples  the  filtered  estimates  from 
the  measurement  data,  as  can  be  seen  from  Figure  4.3,  when 
A(t  )  O.  If  Q  is  too  large,  then  the  uncertainty  level  of  the  steady- 
state  filtered  estimates  will  be  too  high.  The  easiest  initial  factor 
to  determine  is  Ft  (1),  since  it  is  directly  related  to  the  accelerometer 
output  uncertainty. 

A  common  practice  in  applying  a  fi It <•  r  is  to  assume  P(0).  Q(01, 
and  R  (1)  are  diagonal  matrices,  because  of  the  difficulty  in  guessing 
initial  off-diagonal  covariance  elements.  The  second  assumption  is 
that  Q  and  R  arc  stationary.  In  other  words, 
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for  all  N  >  1 


(5.  12) 


Q(N-l)  =  Q(  0) 

R"(N)  E  R  (1) 

Some  preliminary  simulations  were  performed  to  establish 
initial  values  for  P.  Q,  and  R  based  on  the  general  filter  perform 

ance.  The  value  of  P(0)  selected  was  a  diagonal  matrix  whose 
elements  are 


li 


1,2, ....  17 


(5. 13) 


where 


<rx0.  -  are  given  in  Table  5.2 


The  value 


of  Q(0)  selected  was  a  diagonal  matrix  whose  elements 


are 


where 


=  1, 2,  .  .  .  ,  17 


(5.  14) 


o'wj  -  are  given  in  Table  5.4 
And,  finally,  the  elements  of  R  '( 1 )  are 

rjj=<rmj  j  =  1,2,3 


(5. 15) 
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where 


are  given  in  Table  5.4 


No  attempt  was  made  to  optimize  filter  performance  by  varying 
P(0),  Q(0),  and  R  (1).  This  is  also  recommended  for  future  study. 

In  Blocks  7  and  8  of  Figure  5.3,  4th-order  Runge-Kutta 
integration  was  used  with  a  step-size  of  0.25  second.  The  integrals 
for  x  (N)  and  Av(N)  are  both  from  Eq.  (4.51). 


x  (N)  =  x(N-  1 )  +  /  flx(t  |t  , )  1  d t 

J  1  i 

n-  1 


iv(N)  =  / 

J  t  , 
n-  1 


h[x(t|tn_  j)]  dt 


(5.  16) 


(5.  17) 


Note  that,  in  Eq.  (5.  16),  there  are  only  three  elements  of  f  that 
require  integration.  The  elements  of  f  arc  defined  in  Eq.  (5.4). 

Since  the  first  14  elements  of  f  are  zero, 

xf(N)  =  x.(N)  i  1,2 . 14  (5.18) 

In  other  words,  the  filtered  estimates  of  the  first  14  states  are 
identically  equal  to  their  predicted  estimates.  Therefore,  in  Eq. 
(5.2),  which  defines  the  platform  rates  for  Eq.  (5.4),  the  first  14 
states  are  evaluated  at  their  filtered  estimates.  The  Euler  angle 
states  are  the  only  variables  in  Eq.  (5.  16)  that  are  integrated  forward 
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in  time.  Since  the  predicted  states  x  (N)  are  obtained  from  Eq. 

(5.  16),  Eq.  (5.  17)  is  simplified,  since  the  h  function  is  now  a  constant 
function  over  the  integration  step- size  interval  and  is  obtained  by 
evaluating  the  elements  of  h  [  reference  Eq.  (5.5)]  at  the  predicted 
state  values  obtained  from  Eq  (5.  16).  Therefore,  Blocks  7  and  8  are 
integrated  simultaneously. 

Block  9A  is  simply  an  evaluation  of  the  partials  of  F(N-l)  and 
H(N)  at  x(N-l)  and  x  (N)  respectively.  The  analytic  partials  are 
contained  in  Section  C.  1  of  Appendix  C.  Block  9B  is  a  standard 
numerical  partial  subroutine.  The  elements  of  f  and  h  are  evaluated 
at  x(N-l)  and  x  (N),  respectively,  which  establishes  the  nominal 
value  of  the  f  and  h  elements.  The  value  of  each  state  is  varied  by 
some  specified  increment  and  the  perturbation  of  the  f  and  h  elements 
about  their  nominal  values  is  numerically  equivalent  to  the  value  of 
the  partial  of  that  element  with  respect  to  the  incremented  state. 

Since  F(N-  1)  is  not  an  explicit  function  of  time,  the  power  series 
solution  of  Eq.  (4.24)  can  be  used  to  obtain  4>.  Likewise,  r can  be 
obtained  from  its  power  series  solution  of  Eq.  (4.29).  A  value  of 
m  =  4  was  used  in  both  power  series  solutions. 

The  equations  'or  Blocks  11,12,  and  13  are  from  Eq.  (4.52). 
Expressing  them  in  terms  of  N  gives 

P(N)  =  *(N,  N-i)P(N-l)$T(N,N-i) 

+  r(N,N-i)Q(N-nrT(N,N-i)  (5.19) 

A(N)  =  P(N)  HT(N)[H(N)  P(N)  HT(N)  +  R'(N)]"1  (5.20) 
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I 


IMN)  |  I  -  A(N)  H(  N)  |  l‘(N)  1 1  -  A(N)  H(N)1 

I-  A(N)  R '  ( N)  A  1  (N)  (5.  21] 

x(N)  =  x  ( N )  +  A(N)  [  Av(  N)  -  Av(N)]  (5.22] 

Note  that  Av(N)  is  input  to  the  filter  at  Connector  2. 

In  order  to  evaluate  the  effect  of  the  Av  approximation,  an 
alternate  filter,  shown  in  Figure  5.4,  was  used.  The  alternate  filter 
contains  the  Av  approximation  in  the  predicted  measurement  loop. 
The  measurements  from  the  simulation  were  averaged  over  the 
measurement  cycle  to  give  an  average  acceleration  value.  This 
permits  the  ji  equation  evaluated  at  xft^Jt^  j),  which  is  equal  to 

A 

AV(tn|tn  j),  to  be  compared  directly  with  the  average  acceleration 
measurement,  AVft^).  Note  that,  for  this  filter,  the  R  and  H  terms 
of  Eq.  (4.52)  no  longer  contain  the  At  expressions. 

5.4  SIMULATION  RESULTS 

There  were  two  basic  evaluations  of  the  1-g  simulation  per¬ 
formed.  The  first  evaluation  consisted  of  four  simulation  runs  to 
determine  the  filter  performance  with  respect  to  the  initial  state 
estimate  x(0)  =  xq.  In  each  case,  the  vector  difference  between  the 
initial  guess  xq  and  the  true  value  of  the  initial  state  mean  xq,  given 
in  Table  5.2,  was  increased.  The  second  evaluation  was  a  compari¬ 
son  of  the  results  obtained  from  the  basic  filter  of  Figure  4.3  and  the 
alternate  filter  of  Figure  5.4.  The  comparison  was  made  to  show  the 
effect  of  the  Av  approximation  on  filter  performance. 


For  the  first  evaluation,  Table  5.  5  shows  the  value  of  the  initial 
guess  xq  for  each  state  variable.  Except  for  the  accelerometer  scale 
factors,  which  were  assumed  to  be  1  x  10^  ng/g  for  each  simulation 
run,  the  other  14  elements  of  Tt  were  varied  by  a  percentage  of  xq. 
Determining  whether  the  percent  variation  would  be  above  or  below  the 
true  value  of  x^  was  done  by  random  choice  (i.e.  ,  a  flip  of  a  coin), 
except  for  the  100-pcrcent  case,  where  all  values  except  the  scale 
factors  were  set  to  zero. 

The  results  of  the  10-percent  case  are  given  in  Table  5.6.  x  is 
the  filtered  estimate  and  x  is  the  true  or  simulated  value  of  the  state 
associated  with  the  6200th  measurement  cycle.  The  estimation  error 
x  =  x  -  x  is  either  below  or  approximately  midway  in  the  CarouBel  VB 
error  budget  range  for  every  sensor  parameter.  The  standard  devi¬ 
ation  column  <r  is  the  square  root  of  the  diagonal  elements  in  the 
filtering  error  covariance  matrix  P.  From  Eqs.  (4.42)  and  (4.46), 
we  see  that  P  is  associated  with  the  state  perturbation  sequence 
6x(tn).  Therefore,  an  expression  for  the  filtering  error  is 

6x(t  It  )  =  6x(t  )  -  6x(t  It  )  (5.23) 

n  1  n  n  n  1  n 


If  the  perturbations  are  "small",  then,  from  Eqs.  (4.40)  and  (4.49), 
we  see  that 


6x(t  )  =  x ( t  )  -  x(t  It  . ) 
n  n  n 1  n-  1 

6x(t  It  )  =x(t  It  )  -  x(t  ]t  .) 
n  1  n  n  1  n  n 1  n- * 


(5.24) 
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Values  of  Initial  State  Estimate  for  1-g  Simulation 
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Table  5.6.  Results  of  10-Percent  Case  for  1-g  Simulation 
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Substituting  the  equations  of  Eq.  (5.24)  into  Eq.  (5.23)  gives 

6x(t  |t  )  =  x(t  )  -  x(t  It  )  =  x  (5.25) 

n  1  n  n  n '  n 

Since  the  mean  value  of  x  is  identical  to  the  mean  value  of  x,  taking 
the  expectation  of  Eq.  (5.25)  would  show  that  the  filtering  error  and 
therefore  the  estimation  error  sequences  have  zero  means.  Hence, 
a  comparison  of  x  (i.  e.,  x  -  x)  with  <r  should  give  an  indication  of  how 
well  the  filter  is  performing  with  respect  to  the  validity  of  the  lineari¬ 
zation  and  the  effect  of  the  Av  approximation.  A  comparison  of  x  and 
<r  in  Table  5.6  shows  that,  except  for  K^y  and  Kjy,  t*le  appears 

to  be  performing  quite  well.  This  question  still  remains,  however: 
what  is  causing  the  degradation  in  the  above  parameters?  One  logical 
conclusion  is  that  either  the  Av  approximation  or  linearization  is 
affecting  the  estimates  of  Kpy  and  Kjy  or  possibly  the  value  of  Q  is 
too  high  for  these  terms,  as  discussed  in  the  last  section. 

Most  textbooks  on  estimation  theory  discuss  the  value  of  the 

—  2 

diagonal  terms  of  P  (which  are  equal  to  (r  )  in  assessing  the  filter 
performance.  If  the  variance  terms  are  getting  smaller  with  time, 
the  estimates  will  approach  an  optimal  value  for  a  linear  application. 
A  question  arises  as  to  whether  the  off-diagonal  terms  contain  any 
information  in  regard  to  filter  performance  for  linear  or  nonlinear 
applications.  As  mentioned  in  Section  4,  one  concern  of  the  calibra¬ 
tion  problem  was  observability.  Because  of  this,  the  computer 
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printout  of  the  P  matrix  was  restructured  to  give  the  standard 
deviation  along  the  diagonal  and  the  correlation  coefficient  p  of  each 
estimation  error  state,  with  respect  to  every  other  state,  in  the  off- 
diagonal  terms.  The  correlation  coefficient  between  two  random 
variables  x.  and  x.  is  [18] 


cov(x.x.) 

p..  - - ljl 

ij  <r.«r. 


i  J 


(5.26) 


where 


covfx.x.)  -  is  the  covariance  of  x.  and  x. 
1  J  1  J 

°£  |p..|£1.0 


The  result  of  restructuring  P  provided  an  excellent  basis  for 
studying  the  interrelationships  and  influence  patterns  that  exist  between 
each  estimation  error  state. 

Table  5.7  gives  the  accelerometer  parameter  correlation  pattern 
for  the  three  sensors.  The  correlation  coefficient  values  are  from  the 
restructured  P  matrix  for  the  6200th  measurement  cycle.  The  reason 
for  the  degration  of  Kqy  and  Kjy  now  becomes  apparent  from  the 
value  of  0.94  for  their  correlation  coefficient.  In  other  words,  the 
filter  is  having  difficulty  distinguishing  between  them.  Since  they  are 
both  gaussian  random  variables  their  associated  x^  are  gaussian,  and 
hence  correlation  implies  dependence  [16].  An  examination  of  Eq. 
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(5.5)  con  fi  rms  this  fact.  The  relationship  of  Kq  y  ( and  K  j  y  (x  j  j ) 

is  contained  in  the  h^  equation.  The  torque  profile'  is  driving  the  y 

axis  of  the  platform  from  horizontal  to  -90  deg.  As  the  y  axis  gets 

close  to  -90  deg,  the  change  in  the  contribution  of  the  term  (which 

represents  the  amount  of  applied  g)  becomes  very  small,  because  of 

the  sin  a{a  =  x^)  term.  This  means  that  the  K^y  +  Kj,,  E^  term 

"looks  like"  a  single  bias  term,  in  ether  words,  a  linear  combination 

of  two  constant  terms.  1  is  not  until  n  is  of  such  magnitude  that  y  is 

P 

close  to  the  horizontal  that  the  change  in  E£^  becomes  large  enough 
for  the  filter  to  distinguish  between  the  two  terms,  which  implies  a 
decrease  in  p.  Note  that  P  =  Xj^  is  usually  less  than  20  deg,  so  that 
cos  P  is  close  to  1.0.  The  following  list  of  or  versus  p  (for  K^y  and 
Kjy)  taken  from  simulation  data  shows  the  change  in  correlation  as  a 
function  of  the  torque  profile. 


0° 

-78* 

-90* 

-106* 

-169° 

-223  *  (43*  above  horizontal) 


£ 

0. 0033 
0.52 
0.70 
0.  97 


0.  94  <N  =  6200) 


0.7  1 


We  now  see  how  command  torquing  can  be  used  to  offset  the  observ¬ 
ability  problem. 
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Based  on  the  above,  il  is  concluded  that  the  degradation  of  the 
estimates  of  Kgy  and  Kjy  'K  f*uc  lo  observability  effect,  rather 
than  the  linearization  or  Av  approximation.  Hence,  the  results  show 
that  the  linearization  is  valid  and  the  effect  of  the  Av  approximation 
in  the  gain  computation  is  minimal.  The  important  point  is  that  the 
off-diagonal  terms  have  provided  a  new  dimension  in  assessing  filter 
performance . 

Table  5.8  contains  the  results  of  the  30-percent  case.  Since 
the  correlation  pattern  of  Table  5.7  also  holds  in  this  case,  we  see 
how  the  observability  effect  has  again  degraded  the  estimates  of  K^y 
and  Kjy  It  is  interesting  to  note  the  improvement  in  the  estimates 
of  r|Xo  and  i|;x.  for  the  30-percent  case  compared  to  the  10-percent 
case. 

Comparing  the  x  results  of  Tables  5.6  and  5.8,  we  see  that  the 

estimates  for  KjX  are  essentially  the  same,  but  the  estimate  for  KQX 

has  improved  x  by  approximately  two-thirds.  The  improvement  in 

Kqj,  has  an  effect  on  as  shown  by  hj  of  Eq.  (5.5),  and  therefore 

the  estimate  of  should  improve.  The  same  holds  true  for 

which  is  related  to  D_,v  and  DTV.  The  x  results  show  that  the  esti- 

FX  IX 

mates  of  Dp^  are  essentially  the  same,  but  the  estimate  for 
has  improved  x  by  a  factor  of  four.  Equation  (5.2)  shows  that  an 
improvement  in  should  improve  the  estimate  of  TXo* 

The  results  of  Table  5.8  show,  once  again,  that  the  linearization 
is  valid  and  the  effect  of  the  Av  approximation  is  minimal.  Even  with 
the  slight  degradation  in  the  estimates  of  Kpy  and  Kjy,  the  estimation 
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I  able  5.8.  Results  of  30-Percent  Case  for  1-g  Simulation 
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error  of  each  sensor  parameter  is  below  or  within  the  Carousel  VB 
error  budget.  Component  tests  are  conducted,  in  addition  to  prelimi¬ 
nary  platform  checkout  tests,  prior  to  the  1-g  calibration,  implying 
that  knowledge  of  the  sensor  paramete-  magnitudes  should  be  within 
30  percent  for  establishing  an  initial  guess  xQ.  Therefore,  the  30- 
percent  case  should  be  quite  representative  of  an  actual  laboratory 
calibration  program.  It  should  be  noted  that  for  both  the  30-percent 
and  10-percent  cases,  the  total  filtering  time  was  slightly  over  1  hour 
and  43  minutes.  Platform  calibrations  being  performed  for  industrial 
and  military  applications  require  24  to  48  hours  to  obtain  sensor  para¬ 
meters.  Keeping  in  mind  that  the  results  given  here  are  based  on 
simulated  measurement  data,  the  reduction  in  calibration  time  still 
appears  significant. 

Table  5.9  contains  the  results  of  the  60-percent  case.  Since  we 
know  from  the  last  case  that  the  filter  converges  to  within  the  error 
budget  from  an  initial  condition  of  30  percent  of  xQ,  our  only  concern 
here  is  that  the  estimates  are  at  least  within  30  percent  of  x.  Hence, 
instead  of  the  error  budget  column,  a  "%  of  x"  is  shown.  We  see  that 
all  the  parameters,  except  the  misalignment  angles,  are  within  10 
percent.  The  angles  are  within  28  percent.  As  indicated  by  the 
asterisk,  eight  of  the  14  parameters  are  within  the  error  budget. 

Notice  that  the  filtering  time  is  only  7  minutes  longer  than  the  10- 
percent  and  30- percent  cases.  The  P  variances  indicated  that  the 
filter  was  still  converging  at  the  final  cycle. 

The  results  of  the  100-percent  case  are  in  Table  5.  10.  The 
filtering  time  was  increased  by  approximately  17  minutes  over  the 


60-percent  case.  The  results  show,  that  nine  of  the  14  parameters  are 
within  the  error  budget  and  four  of  the  last  five  are  very  close  to  the 
error  budget.  All  parameters  are  within  23  percent  of  x.  The  impor¬ 
tant  point  about  the  100- percent  case  is  that  it  truly  represents  a 
worst  case  condition,  since  we  assume  no  knowledge  of  the  sensor 
parameters  for  the  initial  condition.  The  results  of  the  100-percent 
case  indicate  that  the  1-g  calibration  problem  is  quite  stable  v  ith 
respect  to  the  initial  state  estimate. 

The  second  evaluation  consists  of  a  single  simulation  run  of  the 
alternate  filter  of  Figure  5.4.  All  the  conditions  of  the  3  0- percent 
case  of  the  basic  filter  were  duplicated,  so  that  the  only  difference 
was  that  the  Av  approximation  was  removed  from  the  gain  computation 
and  located  in  the  measurement  prediction  loop,  as  shown  in  Figure 
5.4.  The  results  of  the  alternate  filter  are  shown  in  Table  5.11,  along 
with  the  results  obtained  from  the  basic  filter,  which  were  extracted 
from  Table  5.8.  A  comparison  of  the  estimation  error  values  shows 
that  the  Av  approximation  in  the  predicted  measurement  loop  definitely 
degrades  filter  performance.  Note  that  five  of  the  alternate  filter 
parameters  are  within  the  error  budget.  It  appeared  that  there  was  a 
remote  possibility  that  the  alternate  filter  would  converge;  however, 
the  loss  of  filtering  efficiency  is  apparent.  Note  the  difference  in  the 
estimation  error  for  the  Euler  angles.  The  alternate  filter  is  obviously 
not  tracking  the  platform  nearly  as  well  as  the  basic  filter.  This 
concludes  the  1-g  simulation  results. 
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Table  5.  11.  Comparison  of  Basic  and  Alternate  Filters  for 
Av  Approximation 


State 

Variable 

X  of 

Basic  Filter 

x  of 

Alternate  Filter 

Units 

°FX 

0.998 

25.877 

meru 

dfy 

0.  553 

8.079 

meru 

dfz 

-0.235 

-10.311 

meru 

DIX 

0.  058 

90. 223 

meru/ g 

diy 

0.  665 

89.  070 

meru/g 

DIZ 

0.  860 

110.043 

meru/ g 

Kox 

-4. 506 

-21 . 171* 

Kg 

koy 

-68. 685 

-128.034 

Kg 

Koz 

-3.001 

-7.856* 

Kg 

Kix 

-16. 57 

-54.03* 

Kg/g 

KlY 

-74.09 

-155.81 

Kg/g 

K1Z 

-21.98 

-18.79* 

Kg/g 

*o 

0.244 

0.608* 

arc-sec 

4*  x- 

0.  852 

15.157 

arc-sec 

a 

-17.70 

-634.69 

arc-sec 

P 

102.22 

9230.82 

arc-sec 

V 

24.46 

1825.49 

arc -sec 

N  =  6200  cycles  Time  =  1  hr  43  min  20  sec 

Indicates  parameters  of  Alternate  Filter  where  x  is  within 
error  budget. 


SECTION  6 


SIMULATION  OF  A  CENTRIFUGE  CALIBRATION 

The  results  of  a  10-state  simulation  of  an  operating  centrifuge 
calibration  are  given  in  this  section.  The  measurement  data  was  gen¬ 
erated  by  simulating  the  platform  motion  due  to  error  drift,  earth- rate 
input,  and  a  prespecified  command-torquing  profile  for  the  centrifuge 
operating  at  the  1  0- g  level.  The  basic  purpose  of  the  centrifuge  simu¬ 
lation  is  to  determine  the  ability  of  the  filtering  algorithm  to  identify 
and  estimate  the  higher-order  error  coefficients.  In  addition  to  the 
above,  the  program  was  formulated  into  three  different  options  to 
permit  an  evaluation  of  the  various  types  of  fixed  and  first-order 
coefficients  in  combination  with  the  higher-order  terms. 

6.  1  SIMULATION  STATES  AND  EQUATIONS 

The  nine  sensor  parameters  and  three  Euler  angles  considered 
for  the  centrifuge  simulation  are  defined  in  Table  6.  1.  The  first  four 
state  variables  are  fixed  and  first-order  error  coefficients  that  are 
combined  with  the  higher-order  coefficients  in  three  program  options 
to  be  defined  later.  Taese  coefficients  were  included  for  two  reasons: 
first,  to  determine  how  well  the  data  reduction  technique  obtains 
estimates  of  the  fixed  and  first-order  coefficients  in  the  centrifuge 
environment;  second,  to  determine  if  an  observability  problem  exists 
between  the  lower-  aid  higher-order  coefficients,  which  would  degrade 
the  estimates  State  variables  three  through  nine  are  the  second-  and 
third-order  gyro  ana  accelerometer  coefficients.  Note  that  representa¬ 
tion  of  both  in-axis  anc  cross-axis  second-order  terms  for  both  sensors 
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has  been  included  along  with  the  accelerometer  cubic  coefficient.  The 
last  three  state  variables  are  the  Euler  angles  required  for  platform 
tracking.  As  was  the  case  for  the  1-g  simulation,  the  purpose  of  the 
centrifuge  simulation  was  to  validate  the  data  reduction  method. 
Therefore,  a  sufficient  number  of  states  were  included  to  represent 
all  the  basic  types  of  higher-order  coefficients  normally  determined 
from  a  physical  centrifuge  test;  however,  the  total  numbei  of  states 
was  limited  to  keep  the  complex  task  of  structuring  and  analyzing  the 
filter  tractable. 

All  the  sensor  misalignment  angles  were  assumed  to  be  zero  and 
the  torquer  scale  factors  were  assumed  to  be  unity  to  limit  the  number 
of  states.  For  the  reasons  given  in  Section  5.  1  of  Section  5,  the 
models  contained  in  the  state  and  measurement  dynamics  of  the  pre¬ 
dicted  filter  loops  were  assumed  identical  to  those  used  to  generate 
the  measurement  data,  and  the  servo  error  term  of  Eq.  (2.  33)  was 
assumed  to  be  zero. 

The  state  variables  for  each  of  the  three  program  options  are 
given  in  Table  6.  2.  Since  only  10  states  were  evaluated  for  each 

i 

option,  the  first  column  of  Table  6.  2  merely  shows  the  location  of  the 
specified  state  variables  in  the  10-element  state  vector  x(t).  In  other 
words,  for  the  Basic  Option:  is  the  first  element  of  the  state 

vector,  x^  is  the  second  element,  and  so  forth.  All  equations  in  this 
section  will  be  in  terms  of  the  state  variables  of  Table  6.  1.  The 
analytic  partials,  contained  in  Section  C.  2  of  Appendix  C,  are  in  terms 
of  the  same  state  variables.  So  that  there  is  no  confusion,  any  time  we 
are  referring  to  the  subscripted  variable  x^,  it  will  be  clearly  identified 
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in  the  text  material  whether  we  are  referring  to  the  state  variables  of 
Table  6.  1  or  to  an  element  of  a  state  vector  such  as  x(t),  x(t),  or  x  (t). 
For  example,  in  Section  C.  2,  the  analytic  partials  of  the  state  function  F 

a 

are  evaluated  at  the  filtered  estimate  x.  Since  the  analytic  partials  are 
in  terms  of  the  state  variables,  Table  6.  2  shows  that,  when  we  evalu¬ 
ate  F  for  the  Basic  Option,  we  replace  the  state  variable  x^  in  the 

A 

partial  equations  with  the  first  element  of  the  filtered  state  vector  x^ . 

A 

This  is  shown  in  Appendix  C  by  the  defining  equation  x^  s  Xj,  which 
means  replacing  state  variable  x^  by  the  first  element  of  the  filtered 
state  vector. 

Since  the  major  portion  of  the  platform  error  drift  is  due  to  the 
contribution  from  the  fixed  and  first-order  terms,  those  terms  that 
were  not  designated  as  state  variables  were  added  to  the  simulation  as 
constant  inputs,  so  that  the  platform  drift  is  representative  of  the 
actual  magnitude  expected  during  a  centrifuge  calibration.  The  input 
constants  common  to  all  three  options  are  shown  in  the  first  column 
of  Table  6.  3.  Note  that  Dqz  rather  than  was  arbitrarily  chosen  to 
represent  the  mass  unbalance  term  for  the  Z  gyro.  In  addition  to  the 
above,  those  state  variables  not  included  in  a  specific  program  option 
were  also  set  equal  to  a  constant  value,  as  shown  in  columns  two 
through  four  of  Table  6.3.  In  other  words,  for  the  Basic  Option,  state 
variables  Xj  and  x^  are  not  used  in  the  filter  state  vector;  therefore, 
they  were  set  equal  to  the  constant  values  specified  in  column  two. 

Hence,  any  time  an  equation  contains  the  symboled  form  of  the  sensor 
parameters  (i.  e.  ,  Dp^,  ^OX’  constant  values  of  Table  6.  3 

are  used.  For  example,  in  the  expression 


DFX  +  x3  aIAX 


x^  refers  to  the  state  variable  of  Table  6.  1,  and  Dp^  refers  to  '.he 
constant  input  value  of  Table  6.3. 

To  obtain  the  simulation  equations,  we  need  to  identify  the  charac¬ 
teristics  of  the  centrifuge  coordinate  transformations  defined  in  tac¬ 
tion  3.  The  first  assumption  concerning  the  centrifuge  is  that  We  have 
perfect  counter-rotation  such  that  the  system  platform  is  completely 
isolated  from  the  centrifuge  rate.  This  implies  that  the  misalignment 
angles  and  speed  variations  of  both  the  main  and  CRP  spindles  and 
drive  systems,  respectively,  are  zero.  Second,  we  assume  that  the 
1 -pulse-per-revolution  station  is  perfectly  aligned  with  the  East. 

Third,  we  assume  perfect  alignment  of  the  centrifuge  main  arm 
centerline,  CRP  X^  axis,  and  the  1 -pulse-per-revolution  station. 
Finally,  we  assume  that  the  static  and  dynamic  change  in  centrifuge 
radius  from  its  nominal  value  is  zero. 

The  assumptions  are  not  as  drastic  as  they  appear.  As  dis¬ 
cussed  in  Section  3,  the  spindle  misalignments,  drive  system  varia¬ 
tions,  and  the  arm  stretch  are  all  measurable  quantities  obtained  by 
the  various  centrifuge  systems  discussed  in  Section  3.1.  In  the  case 
of  the  alignment  of  the  centrifuge  main  arm,  1 -pulse-per-revolution 
station,  and  the  CRP  axes,  these  are  also  quantities  measured  during 
the  initial  platform  installation  and  alignment  phase.  Hence,  all  the 
above  quantities  a-  ount  to  deterministic  coordinate  transformations 
Since  our  purpose  is  to  validate  the  data  reduction  technique,  nothing 
is  gained  by  complicating  the  platform  rate  equations  with  additional 
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deterministic  factors  Keeping  in  mind  that  our  concern  in  the 
calibration  problem  is  not  that  the  system  is  isolated  from  the  centri¬ 
fuge  rate,  but  that  we  are  able  to  determine  the  amount  of  centrifuge 
rate  sensed  by  the  system,  so  that  we  can  account  for  this  rate  input 
in  the  platform  rate  equations.  The  best  approach  to  that  problem  is 
to  use  actual  centrifuge  performance  data  to  determine  if  the  measure¬ 
ment  accuracy  of  the  centrifuge  systems  is  sufficient,  and,  in  some 
instances,  verify  that  the  assumed  dynamic  centrifuge  models  and 
coordinate  transformations  of  Section  3  are  valid.  7’he  important 
point  is  that  the  above  approach  is  the  next  logical  step  to  take  after 
having  validated  the  data  reduction  technique  with  a  tractable 
simulation. 


Based  on  the  above  assumptions,  the  following  parameters  for 

the  centrifuge  coordinate  transformations  can  be  defined.  Reference 

Eq.  (3.6),  the  misalignments  are  zero  implying  that  p  =  p  ~  0 

Xi  yc 

The  1 -pulse-per-revolution  station  is  East,  implying  that  the  astro¬ 
nomic  heading  p  ^  =  90  deg  and  therefore  p  =  0  for  Eq.  (3.  7). 

Since  the  main  arm  is  aligned  with  the  ppr  station  p^  =  0;  and  6wc  -  0, 
since  the  centrifuge  rate  is  constant.  Therefore,  the  earth-to- 
centrifuge  transformation  Eq  (3.9),  reduces  to 
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Reference  Eq.  (3.  12),  0xr  =  0^^  =  0,  since  the  misalignments  are 

zero.  Since  X  is  aligned  with  X  0  =  0;  and  6w  =  0,  since  the  CRP 
r  °  co  r 

rateu>r=  u»c  is  constant.  Therefore,  the  centrifuge  to  CRP  transforma¬ 
tion,  Eq.  (3.  14),  reduces  to 


C 


r 

c 


COS  U)  t 

c 

sin  u  t 
c 


0 


-  sin  u  t  0 

c 

cos  u  t  0 

c 

0  1 . 


(6.2) 


From  Eqa.  (6.  1)  and  (6.  2),  we  see  that 


Cr  CC  =  1  (3  X  3)  identity  matrix  (6.  3) 

c  e 


Since  the  arm  stretch  is  zero,  6r  of  Eq.  (3.  16)  is  zero;  this  implies 
that  the  centrifuge  radius  is  equal  to  the  nominal  260-inch  value  tq. 
Finally,  since  the  speed  variations  are  zero  and  <*>co  =  wc, 

Eq.  (3.  17)  reduces  to 


r  ~r  e 

oj.  =  C  w. 

l  r  e  l  e 


(6.4) 


Neglecting  for  now  the  variations  due  to  the  three  program 
options,  we  obtain  a  general  expression  for  the  platform  rate  equations 
using  the  state  variables  of  Table  6.  1  and  the  common  input  constants 
of  Table  6.3. 
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Combining  Eqs.  (3.20),  (6.4),  and  (2.33),  with  the  misalignment 
angles  at  zero,  gives 


-  x  -  x3aJX  -  TGX  -  E^WEC  -  E^WES 
Diyaiy  -  x5'“oy)2  '  TGY  -  E22WEC  -  E23WES 

(6.5) 

-°FZ  -  DOZaOZ  '  x6<aJZ),aSZ)  -  TGZ 

-  E  WEC  -  E  WES 

J  u  J  J 

From  Eqs.  (3.19)  and  (2,34),  we  obtain  a  general  expression  for  the 
platform  acceleration 

AX"  x2  X4aIAX  +  X9(aIAX)(aPX) 

2 

AY  -  ^0Y  +  ^lYaIAY  +  X7^alAY^  (6*^) 

AZ  =  K0Z  +  KlZaIAZ  +  x8(aIAZ) 

We  now  need  to  obtain  expressions  for  the  applied  acceleration  terms 
of  Eqs.  (6.5)  and  (6.6).  Section  B.2  of  Appendix  B  shows  that  the  con¬ 
tribution  of  the  Group  2  terms  of  the  applied  acceleration  equation, 

Eq.  (3.25),  can  be  neglected.  From  the  centrifuge  assumptions  e 
know  that 

rl/  *  rlf  •  »*!/ 

AW  =  W  =  W  3  o  (6.7) 

cr  ec  cr 
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Combining  Eqs.  (6.3)  and  (6.7),  the  applied  acceleration  equation 
reduces  to 


A 6  =  C8CP 
is  p  r 


1 2  WekCeWckRc  +  Ge  +  CrWckWck 
le  c  ec  cr  c  ec  ec 


*c  \ 

erf 


(6.8) 


From  Eqs.  (3.3),  (6.1),  (3,11),  (6.2),  and  (3.25),  the  term  in  the 
brackets  {  }  of  Eq.  (6.8)  can  be  reduced  to 


(6.9) 


where 

2 

r.  =  -u  r  (cos  u>  t)  -  2u  r  (WES)(cos  w  t) 

1  CO  C  CO  c 

2 

r 2  =  -u>cro(sin  u^t)  -  2  wcrQ( WES)(sin  u>ct) 

r,  =  g  +  2w  r  (WEC)(sin  w  t) 

5  co  c 

The  expressions  for  Tj,  r^,  and  r^  can  be  simplified,  since  we  know 
the  centrifuge  angular  rate  u>c  at  the  10-g  level  and  the  nominal  radius 
rQ.  The  components  of  earth- rate,  WEC  and  WES,  are  defined  by 
Eq.  (3.3). 

Given 

u>  3.  8505954  rad/sec 
c 

r  =  260/12  ft 
o 
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WES  =  3 . 95990552  X  10'5  rad/sec 

WEC  =  6.  1232531  X  l0'5  rad/sec 
E  =  32.1232531  ft/sec2  =  1  (g-units) 

We  convert  the  constants  to  g-units  and  obtain 

r i  =  -G1  (cos  c,  t ) 

r2  =  -Gl  (sin  w  t) 

r,  =  1.0  +  G2(sin  co  t) 
J  c 

whe  re 


(6.10) 


G1  =  10.00020568  g's 
G2  =  0.00031805  g's 


Now  Cr  is  the  Euler  transformation  matrix  and  is  the  sensor 
transformations  def.ned  oy  Eqs.  (3.  19)  and  (J.dOh  Therefore,  we  can 
now  solve  for  the  components  of  applied  acceleration. 


aIX  =  aIAX  =  aO/o  "  ^ 

aIY  =  alAY  =  aSZ  r  AY 

alZ  =  alAZ  =  AZ 
aOY  '  aPX  S  ~AZ 


(6. 11) 
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where 


AX  =  -G1[E.  (cos  (jj  t)  +  E._(sin  w  t)]  +  E.,[1.0  +  G2(sir  ui  t)] 
l  c  u  c  la  c 

AY  =  -G1  [E^  j  (cos  ^ct)  +  E22(sin  )j  +  E^^fl.O  +  G2(sin  cu  ^  t )  ] 
AZ  =  -G1[E31(cos  wct)  +  E32(sin  c^t)]  +  E33[l.O  +  G2(sin  u^t)] 

E.j(i,  j  =  1 , 2,  3)  -  are  from  Eq.  (4.1)  with  or  =  Xj  Q,  (3  =  Xj  Jf 
and  V  =  x  j  2 

F rom  Eqs .  (6.  5)  and  (6.11)  and  Table  6.  2,  we  can  obtain  the 
platform  rate  equations  for  the  various  program  options. 

BASIC  AND  OPTION  2 

uxp  =  -Dfx  -  x3(AX)  -  TGX  -  E12WEC  -  E13WES 


OPTION  1 

uxp  =  'X1  ’  DIX(AX)  '  TGX  "  E12WEC  "  Ei3WES  (6.12) 

FOR  ALL  OPTIONS 

Wyp  =  'DFY  '  Diy(AY)  '  x5<AZ>2  -  TGY  -  E22WEC  E23WES 

uzP  =  -dfz  '  Doz(AX)  '  x6(azMay>  -  tgz  -  e32wec  -  e3,wes 


We  see  that  only  u  is  affected  by  the  program  options.  With  the  plat- 
xp 

form  rates  defined  by  Eq.  (6.12),  we  can  define  the  state  vector  equa¬ 
tion  directly  from  Eq.  (4.8). 
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X  -  f(x,  t)  +  Wit) 


(6.  13 


whe  re 


x  and  w  -  are  10-element  vectors  constructed  according  to 
the  options  of  Table  6.2 

_f(x,t)  -  is  a  10-element  vector -valued  function  constructed 
according  to  the  selected  option. 

The  only  difference  between  Eq .  {6.  13)  and  Eq.  (4.8)  is  the  dimen¬ 
sionality  of  the  equation.  We  know  from  Section  4  that  the  first  seven 
elements  ot  are  zero,  and  the  last  three  elements  contain  the 
dynamics  of  the  system  platform  rates. 


f„  =  (co  cos  x,-  4  co  sin  x.^t/cos  x,( 
8  xp  1 2  zp  12  11 


=  >jj  cos  x  .  ,  -  ui  sili  x,., 
9  zp  12  xp  1  \ 


(6.  14 


f ,  „  =  (co  cos  x..sin  x(.  +  w  sin  x  .  ,sin  x ,  ,  )/  cos  x .  ,  t  co 
10  xp  12  11  zp  12  11  1 1  yp 


The  equation  for  cu^  in  Eq.  (6.  14)  is  based  on  the  program  option  as 
shown  in  Eq.  (6.  12).  Hie  statisti  al  description  of  Eq.  (0.  13)  is 
identical  to  Eq.  (4.8j  with  the  dimensionality  adjusted  from  63  to  10. 
1  he  measurement  equation  tor  the  various  program  options  is 


obtained  from  Eqs .  (6.  6)  and  (6.11)  and  Table  6. 2. 


BASIC  AND  OPTION  1 


h1=  Kqx  +  x4<tn)[AX(tn)]  -  xv(tn)[AX(tn)  .  AZ(tn)] 

OPTION  2 

ht  =  x2<tn)  +  Klx[AX(tn)J  -  x9(tn)[AX(tn)  .  AZ(tn)]  (6.15) 
FOR  ALL  OPTIONS 

h2  =  K0Y  +  KlYlAY,t„»]  +x7(tn)[AY(tn)]2 

W  +KlzlA2(tn,l  4 

Wo  see  that  only  h,  is  affected  by  the  program  options.  The  measure¬ 
ment  equation  is  identical  to  Eq,  (4. 14)  with  h[x(tn),  tnJ  defined  by 
Eq.  (6.15)  and  the  selected  program  option. 

6.2  MEASUREMENT  SIMULATION 

Except  for  the  elements  of  the  state  and  measurement  equations, 
the  measurement  simulation  is  identical  to  the  1-g  simulation  develop¬ 
ment  described  in  Section  5.2  of  Section  5.  Table  6.4  contains  a  list 
of  the  means  and  standard  deviations  for  the  state  variables.  These 
values  were  used  to  construct  the  10-element  initial  state  vector  x(t  ), 
based  on  the  specified  program  option.  As  was  the  case  in  Section  5, 
the  values  are  based  on  data  from  the  Carousel  VB  system. 

Table  6.  5  contains  a  list  of  the  standard  deviations  for  the  zero- 
mean,  gaussian  white  disturbance  process  w(t)  and  the  zero-mean, 


Table  6.4  Initial  State  Means  and  Standard  Deviations 


Table  6.  5.  Stand 


guassian  white,  measurement  noise  sequence  m(t  ).  As  was  the  case 

—  n 

in  Section  5,  the  standard  deviations  for  the  sensor  parameter  dis¬ 
turbances  are  10  percent  of  those  listed  in  Table  6.4.  Also,  since  the 
same  torque  profile  was  used,  the  disturbance  added  each  At  measure¬ 
ment  cycle  is  given  by  Eq.  (5.7)  with  i  =  1,2,  .  .  .  ,  10.  The  equations 
of  the  sensor  parameters,  Euler  angles,  and  measurements  are  repre¬ 
sented  by  Eqs.  (5.9),  (5.10),  and  (5.11),  respectively,  with  the  state 
and  measurement  dynamic  equations  given  Eqs.  (6.14)  and  (6.15). 

A  measurement  cycle  of  At  =  0.04  second  was  used  for  the  centri¬ 
fuge  simulation.  This  measurement  cycle  is  identical  to  the  opera¬ 
tional  measurement  cycle  used  for  the  Carousel  VB  inertial  Measure¬ 
ment  Unit.  The  method  of  integrating  the  state  and  measurement 
dynamics  was  4th-order  Runge-Kutta  with  a  step-size  of  0.01  second. 
Based  on  a  nominal  platform  rate  of  5.2  X  10"^  rad/sec  (see  Section  B.2 
of  Appendix  B)  it  is  implied  that  measurements  were  taken  every  0,07 
arc-minutes  of  platform  angle.  Based  on  a  centrifuge  rate  of  3.85 
rad/sec,  it  is  implied  that  measurements  were  taken  every  8.8  deg 
of  centrifuge  angle.  Figure  5.  1  also  represents  the  flow  diagram 
for  the  centrifuge  measurement  simulation  program  with  'he  state  and 
measurement  dynamic  of  Eqs.  (6.  14)  and  (6.15).  Since  At  =  0.04  sec¬ 
ond,  it  is  implied  that  the  maximum  number  of  measurements  over  the 
torque  profile  would  be  128,500.  Fortunately,  tm*  filter  converged 
in  less  than  15,000  cycles,  so  that  it  was  nol^  necessary  to  process 
all  of  these  measuremerts. 
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6.3  FILTER  ALGORITHM 


Except  for  the  elements  of  the  state  and  measurement  dynamic 
equations,  the  filter  algorithm  is  identical  to  the  1-g  simulation  devel* 
opment  given  in  Section  5.3  of  Section  5.  Since  the  state  dynamic  equa¬ 
tion  is  an  explicit  function  of  time,  it  is  implied  that  F  and  4  are  func¬ 
tions  of  time;  therefore,  the  matrix  differencial  equation,  Eq.  (4.22), 
should  be  used  to  obtain  a  solution  of  4.  As  discussed  in  Section  4.4 
of  Section  4,  only  the  elements  of  the  last  three  rows  of  <t>  require  a 
solution  via  Eq.  (4.22).  This  implies  a  total  of  30  differential  equa¬ 
tions.  In  the  case  of  T,  the  adjoint  matrix  differential  equation, 

Eq.  (4.27),  requires  the  integration  of  60  differential  equations  to 
obtain  $  from  tn  back  to  tn _  j ,  as  discussed  in  Section  4;  then  60  addi¬ 
tional  integrations  are  required  to  obtain  T  from  Eq.  (4.26;,  for  a 
total  of  120  integrations.  This  is  a  formidable  task  just  to  transition 
the  "initial  guess"  of  Q(0)  forward  in  time.  Since  Q(0)  is  an  adjustable 
initial  condition,  it  was  decided  to  consider  F  constant  over  the 
0.04  second  measurement  cycle  and  obtain  T  by  the  power  series 
approximation  of  Eq.  (4,29)  with  F  evaluated  at  t  =  tn. 

Another  approach  would  be  to  consider  F  constant  for  the  4 
computation  as  well,  then  use  the  power  series  approximation  of 
Eq.  (4.24),  with  F  evaluated  at  t  =  tn,  to  obtain  4.  An  evaluation  of 
approximating  both  4  and  F  by  the  power  series  method  is  important, 
since,  for  the  general  calibration  problem  containing  63  states,  we 
are  dealing  with  189  integrations  for  4  and  3969  integrations  for  T. 
Therefore,  the  only  significant  difference  in  Figure  5.3  for  the 
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centrifuge  simulation  is  that  Block  10  contained  two  options  for 
obtaining  <I>  and  F.  One  option  obtained  both  by  the  power  series 
method  with  m=  5.  The  second  option  obtained  $  by  a  4th-order 
Runge-Kutta  integration  of  30  differential  equations  using  a  step-size 
of  0.01  second,  and  then  used  the  power  series  approximation  to 
obtain  T. 

The  partial  derivative  matrices  of  F  and  H  are  contained  in  Section 
C.2  of  Appendix  C.  The  construction  of  their  elements  is  based  on  the 
specified  program  option.  As  was  the  case  for  Section  5,  P(0)  was 
assumed  a  diagonal  matrix;  Q(0)  and  R;  (1)  were  assumed  diagonal 
and  stationary.  The  scaling  for  P(0)  and  Q(0)  was  identical  to 
Eqs .  (5.  13)  and  (5.  14),  respectively,  with  i  =  1,  2,  .  .  .  ,  10.  The 
scaling  for  Rv(l)  was  identical  to  Eq.  (5.  15).  All  the  procedures  and 
equations  for  x'  (N),  Av(N),  A(N),  and  x(N)  are  identical  to  those  of 
Section  5  with  At  =  0.04  second,  an  integration  step-size  of  0.01  sec¬ 
ond,  the  dimensionality  raduced  from  17  to  10,  and  the  state  and 
measurement  dynamics  defined  by  Eqs.  (6.  14)  and  (6.  15). 

6.4  SIMULATION  RESULTS 

Before  discussing  the  detailed  final  results  of  the  centrifuge 
simulation,  the  results  obtained  from  some  preliminary  runs  will  be 
given  to  show  how  some  of  the  physical  aspects  of  the  problem  and 
the  correlation  data  obtained  from  the  simulations  were  used  to 
improve  the  estimates  of  the  centrifuge  calibrations.  From  Table  6.4, 
we  see  that  the  initial  values  of  a  and  y  are  a  few  minutes  of  arc.  To 
simplify  the  notation,  we  will  refer  to  this  initial  condition  as  the 
at  -  V  -  0  condition. 


180 


Table  6.6  shows  the  results  of  three  simulation  runs  where  the 


only  difference  was  the  initial  values  assigned  to  a  and  Y.  For  the 
a  =  y  =  0  case,  we  see  that  the  estimation  error  x  (i.e.,  x  -  x)  for  all 
the  sensor  coefficients  except  K32  appear  to  be  quite  small.  In  the 
case  of  we  are  attempting  to  estimate  a  true  value  of  x  =  3. 554  |xg/ g' 
and  x=  1.667  pg/g^,  Obviously,  the  estimate  is  very  poor.  Note, 
however,  that  is  a  coefficient  associated  with  the  Z  accelerometer, 
and  the  Z  platform  axis  is  vertically  up  at  the  start  of  the  calibration. 
Since  the  filtering  time  is  only  5  minutes,  we  see  from  the  true  values 
of  a,  p,  and  V  that  the  Z  axis  has  only  moved  approximately  9  deg  from 
the  vertical.  This  means  that  the  Z  accelerometer  has  sensed  only  the 
local  gravity  value  of  1-g,  compared  to  the  other  platform  axes  which 
have  sensed  a  peak.-to-peak  acceleration  of  20  g's.  The  coefficient 

information  is  essentially  "buried"  in  the  noise.  To  correct  this  physi- 
cal  situation,  the  initial  condition  of  a  was  changed  to  -45  deg,  which 
places  the  Z  axis  45  deg  above  the  horizontal  and  permits  the  Z  acceler¬ 
ometer  to  sense  a  component  of  centrifuge  acceleration.  The  results 
of  this  simulation  are  in  the  a  =  -45  Y  =  0  column.  We  can  now  see  the 


significant  improvement  in  the  estimation  error,  from  1,667  to 
3 

0.017  pg/g  .  An  interesting  comparison  can  also  be  made  with  the 


K3Z  correlation  pattern  for  the  two  cases.  The  following  correlation 
pattern  gives  the  sensor  parameter  that  is  correlated  with  and 
the  amount  of  correlation,  p,  for  the  two  cases 


_ Ji 

Sensor  Parameter 

a  =  0  Correlation 

a  -  -45  Correlation 

DIX 

0.45 

0.063 

0.50 

0.40 


0.23 

0.026 


The  correlation  pattern  definitely  shows  the  estimates  of  should 

be  better  with  the  /C  axis  4  5  deg  above  the  horizontal.  Once  again  we 
see  a  relationship  between  the  correlation  pattern,  provided  by  the 
off-diagonal  P  matrix  terms,  and  the  torque  profile  via  platform 
orientation. 

Comparing  the  a  =  0  to  a  =  -4  5  V  =  0  case,  we  see  that  another 
problem  has  developed.  The  estimate  for  has  degraded  signifi¬ 
cantly.  A  review  of  the  1-g  simulation  results  showed  that  the  corre¬ 
lation  pattern  (especially  with  a)  and  x  improved  tremendously  when 
•y  =  -45  deg.  The  results  of  the  a  -  -45  y  =  -45  column  verify  the  1-g 
analysis  and  show  thal  %  significant  improvement  in  the  estimate 
has  occurred,  along  with  a  further  improvement  in  the  estimate. 

The  slight  degradation  of  Kj^.  is  not  significant,  since  approximately 
260  seconds  later  in  the  a  -  -45  V  =  -45  run,  x  for  drops  to 
-0.78  pg/g  and  stays  there;  in  other  words,  it  takes  a  little  longer 
to  converge  the  Kj^  estimate.  Once  again  the  correlation  pattern  of 
DjX  for  all  three  cases  shows  the  relative  degradation  or  improvement 
of  the  Djx  estimate  with  respect  to  the  platform  orientation. 
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Sensor  Parameter 


a  -  0 
Y  =  0 

Correlation 


0.076 


a  =  -45 
Y  -  0 

Correlation 


0.  54 
0.56 


a  =  -45 
Y  =  -45 
Correlation 


0.061 

0.23 


Based  on  the  above,  the  two  program  options  ihat  contain  D^,  Basic 
and  Option  2,  were  run  with  the  initial  values  of  a  and  Y  set  to  -45  deg. 

In  the  case  of  Option  1,  only  the  initial  value  of  a  was  set  to  -45  deg  to 
permit  recovery  of  the  term. 

Nothing  has  been  said  thus  far  about  the  initial  state  estimate 
xq  =  x(0)  for  the  centrifuge  simulations.  The  initial  estimates  for  all 
the  higher-order  coeffic  ents,  state  variables  x^  through  x^,  were 
always  set  equal  to  zero.  Since  we  assume  we  know  nothing  about 
these  coefficients,  zero  is  the  logical  choice.  For  the  fixed  and  first- 
order  coefficients,  state  variables  Xj  through  x^,  the  initial  estimate 
of  the  scale  factor  was  always  set  equal  to  1.0  X  10^  pg/g,  and  the 
other  three  coefficients  were  varied  by  either  10  percent  or  30  percent 
of  the  respective  xQ.  (i  =  1,2,3)  contained  in  Table  6.4.  In  the  case 
of  the  Euler  angles,  the  10-percent  or  30-percent  variations  of 
(i  =  10,  11,  12)  were  obviously  applied  about  the  new  initial  values  of  -45 
deg,  rather  than  xq,  for  those  angles  with  the  45-deg  offset.  The  differ¬ 
ence  in  the  results  from  the  10-percent  and  30-percent  simulations  is  so 
insignificant  that  only  the  30-percent  results  for  the  three  program 
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options  will  be  presented.  Selection  of  the  30-percent  case  is  rather 
conservative,  since  the  initial  estimates  for  the  fixed  and  first-order 
coefficients  will  normally  be  provided  by  the  precentrifuge  1-g  calibra¬ 
tion;  and  as  was  shown  in  Section  5,  even  the  100- percent  case  con¬ 
verged  to  within  30  percent.  A  worst  case  run  was  also  made  for  the 
centrifuge  simulation,  where  all  the  coefficient  initial  estimates  except 
the  scale  factor  and  offset  angles  (a  =  y  =  -45  deg)  were  set  to  zero. 

As  discussed  in  the  last  section,  there  were  two  options  avail¬ 
able  for  computing  $  and  T.  The  option  that  obtained  both  by  the  power 
series  approximation  is  referred  to  as  TOPT  =  0,  where  TOPT  stands 
for  transition  option.  The  option  that  obtained  4>  by  integration  and  F 
by  the  power  series  approximation  will  be  referred  to  as  TOPT  =  1. 
Table  6.7  contains  a  comparison  of  the  results  of  the  two  transition 
options.  Since  the  differences  are  so  small,  all  the  digits  available 
from  the  computer  printout  are  provided  to  permit  a  complete  compari¬ 
son.  The  results  show  that  assuming  F  to  be  constant  over  the 
0.04-8econd  measurement  interval  and  computing  and  Tfrom  the 
power  series  approximation  with  m  =  5  is  a  valid  approximation. 
Therefore,  TOPT  =  0  was  used  for  all  the  remaining  simulation  runs. 
This  result  is  encouraging,  since  the  63-state  general  calibration  pro¬ 
gram  becomes  much  simpler  if  all  the  integrations  associated  with  4 
and  r  can  be  eliminated.  It  should  be  noted  that  the  approximation  was 
probably  valid  because  of  the  short  measurement  cycle  time;  however, 
for  most  missile  applications,  the  measurement  cycle  time  ranges 
from  0.02  to  0.05  second  in  order  to  meet  operational  accuracy 
requirements. 
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Table  6.7.  Comparison  of  Transition  Opti 
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Block  9  of  Figure  5.3  shows  that  two  options  were  available  for 
computing  the  F  and  H  partials  for  the  filter.  Table  6.8  shows  the 
results  of  two  simulation  runs,  whose  only  difference  was  that  one  was 
based  on  the  analytic  partials  of  Appendix  C  and  the  other  was  based 
on  the  numerical  partial  routine.  It  should  be  understood  that  no  effort 
was  made  to  improve  the  results  of  the  routine,  such  as  adjusting  the 
incremental  perturbation  levels,  since  Ihe  basic  purpose  of  the  numeri¬ 
cal  partials  was  to  provide  a  basis  for  comparison  and  checkout  of  the 
hand  calculated  analytic  partials.  The  results  of  the  numerical  partials 
compare  quite  well  with  the  analytic  results,  especially  to  one  who  had 
the  "pleasure"  of  hand  calculating  the  162  partials  of  Appendix  C.  With 
further  refinements  on  the  numerical  partial  routine,  a  major  simpli¬ 
fication  of  the  63 -state  calibration  program  could  be  achieved  using 
numerical  partials. 

The  results  of  the  30-percent  case  for  the  Basic  Option,  Option  1, 
and  Option  2  are  contained  in  Tables  6.9,  6.10,  and  6.11,  respectively. 
Except  for  Kjp^  in  two  program  options,  all  the  values  of  the  estima¬ 
tion  error,  x,  are  well  within  the  error  budget.  The  error  budget 


values  for  K^y,  K^,  and  were  obtained  from  the  Central  Iner¬ 

tial  Guidance  Test  Facility  at  Holloman  AFB,  since  no  values  were 


defined  for  the  Carousel  VB  error  budget.  The  values  for  the  above 


accelerometer  error  coefficients  are  nominal  error  values  that  are 


representative  of  the  quality  of  accelerometer  used  on  the  Carousel  VB 
platform.  In  the  case  of  Kjp^,  we  see  that  the  largest  value  of  x  was 
obtained  with  Option  1,  where  the  initial  offset  was  a  =  -45  deg.  For 
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Table  6.8.  Comparison  of  Analytic  and  Numerical  Partials 


Results  of  30-Percent  Case  Option  1 
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Table  6.11.  Results  of  30-Percent  Ca 


the  Basic  Option  and  Option  2,  the  initial  offset  was  a  =  y  =  -45  deg. 

We  see  that  the  value  of  x  is  improved  for  the  Basic  Option  and  within 

the  error  budget  for  Option  2.  Comparing  the  Kjp^  estimation  error 

values  for  the  two  transition  options  of  Table  6.7,  we  see  that  the 

approximation  of  4>  is  not  responsible  for  the  degradation  of  the  Kjp^ 

estimate.  Table  6.6  shows  significant  differences  in  the  Kjp^  value 

of  x  for  three  different  initial  offset  cases  of  the  Basic  Option.  The 

significant  improvement  of  Kjp^  for  the  a  =  -4  5  y  =  0  case  appears 

to  conflict  with  the  results  of  the  30-percent  case,  where  the  worst 

value  of  x  for  Kjp^  was  obtained  with  Option  1,  where  a  =  -45  deg 

and  y  =  0  deg.  The  a  -  -45  y  -  -45  and  a  =  -45  \  =  0  cases  were 

both  run  for  a  total  filtering  time  of  10  minutes.  The  results  at  the 

10-minute  point  were  identical  to  those  shown  in  Tables  6.9  and  6.10 

~  2 

for  the  Basic  Option  and  Option  1  (i.e.,  x  =  0.  1  1720  pg/g  and 
x  =  0.  18937  pg/g  ,  respectively).  The  interesting  point  is  that  at  the 
5-minute  point,  for  the  a  =  -45  y  =  0  case  ot  Table  6.6,  the  correla¬ 
tion  coefficients  of  K^p^  with  D^,  K^y,  M  a,  and  (3  were  2  to  3 
orders  of  magnitude  lower  than  those  values  for  the  a  -  0  y  =  0  and 
a  =  -45  y  =  -45  cases  at  the  5  minute  point.  Also,  the  correlation 
pattern  was  improved  fcr  the  30-percent  Option  2  case,  as  compared 
to  the  30-percent  Basic  Option,  with  respect  to  and  K^, 
respectively.  It  now  becomes  apparent  that  K^p^  is  extremely  sensi¬ 
tive  to  the  platform  orientation  and  to  the  other  accelerometer  param¬ 
eters  along  the  x  axis;  in  other  words,  the  estimate  is  improved  when 
coupled  with  a  bias  term  (KqX^'  i^en  wii.h  a  scale  factor  term 
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Now,  since  Kjp^  is  a  cross-axis  term,  it  is  not  surprising  that  it  is 
highly  sensitive  to  the  platform  orientation.  Also,  it  is  not  surprising 
that  the  correlation  pattern  is  improved  when  compared  to  a  constant 
bias  term,  which  should  be  easily  distinguished  from  a  second-order 
term  when  sinusoidal  acceleration  is  applied.  Therefore,  the  conclu¬ 
sion  is  that  a  more  favorable  orientation  that  decouples  Kjp^  from  the 
other  sensor  parameters  is  required  for  a  good  estimate  of  the  Kjp^ 
coefficient.  1  ? 

The  results  of  the  worst  or  100-percent  case  using  the  Basic 
Option  are  contained  in  Table  6.12.  Considering  that  the  filtering 
time  was  only  increased  by  5  minutes  over  the  30-percent  case,  the 
results  are  truly  incredible.  Four  of  seven  coefficients  are  already 
within  the  error  budget,  and  the  remaining  three  coefficients  are 
extremely  close. 

Comparing  the  results  of  x  or  ir  in  Tables  6.  9  through  6.  12,  we 
see  that  the  relative  difference  between  x  and  o’  is  larger  for  the 
centrifuge  simulation  than  for  the  1-g  simulation.  In  the  1-g  simula¬ 
tion,  the  values  of  x,  which  represent  the  state  perturbations,  were 
about  the  same  magnitude  or  smaller  than  the  standard  deviations,  <r, 
of  the  filtering  error.  Table  6.  13  gives  a  comparison  of  the  1-g  and 
centrifuge  simulation  filter  performance  for  those  fixed  and  first- 
order  coefficients  common  to  both  simulations.  In  order  to  have  a 
common  base  for  comparison,  the  results  are  compared  for  an  equal 
value  of  N  measurement  cycles,  rather  than  an  equal  time  of  filtering. 
In  other  words,  we  are  comparing  the  filter  performance  based  on  the 
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Table  6.  12.  Results  of  100- Percent  Case  Basic  Option 
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results  after  processing  the  same  number  of  measurements:  6200  in 
the  30-percent  case  and  7600  in  the  100-percent  case.  The  results  of 
Table  6.  13  show  that  even  though  the  relative  difference  between  x  and 
cr  is  larger  for  the  centrifuge  simulation,  the  values  of  x  (state 
perturbations)  for  the  centrifuge  simulation  arc  smaller  than  those  of 
l-g  simulation  in  the  majority  of  cases.  Comparing  the  cr  values  of 
the  centrifuge  versus  the  l-g  simulation,  we  now  see  that  the  filter 
performance  was  vastly  improved  for  the  centrifuge  simulation.  In 
fact,  the  performance  was  so  improved  that  the  value  of  Q  was  main¬ 
tained  in  order  to  prevent  the  filter  gain  from  approaching  zero  and 
thereby  decoupling  the  filtered  estimates  from  the  measurement  data 
as  discussed  in  Section  5.3  of  Section  5 

The  results  of  the  centrifuge  simulation  have  again  verified  that 
the  linearization  is  valid,  that  the  effect  of  the  Av  approximation  is 
minimal,  and  that  the  computation  of  the  filter  can  be  simplified  by 
assuming  F  is  constant  over  the  measurement  interval  and  thereby 
<t>  can  be  obtained  via  the  power  series  approximation.  Except  for 
Kjpx»  the  correlation  data  for  the  centrifuge  simulation  showed  that 
there  is  no  observability  problem  for  those  coefficients  considered  for 
the  centrifuge  simulation.  This  concludes  the  centrifuge  simulation 
results . 
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SECTION  7 


SUMMARY  AND  RECOMMENDATIONS  FOR  FUTURE  STUDY 

The  objective  of  the  report  was  to  investigate  a  data  reduction 
technique  that  obtains  estimates  of  inertial  sensor  error  model  coeffi¬ 
cients  from  a  laboratory  calibration  of  an  Inertial  Navigation  System. 
The  results  of  Sections  5  and  6  reveal  that  this  objective  has  been 
achieved;  however,  throughout  the  preceding  sections,  a  number  of 
simplifying  model  assumptions  were  made  based  on  calculations  of 
and/or  assumptions  made  concerning  sensor  and  platform  design  char¬ 
acteristics,  assumptions  of  the  centrifuge  performance  and  dynamic 
environment,  and  assumptions  of  the  statistical  model  used  for  the 
sensor  parameters.  In  this  section,  we  will  briefly  review  these 
simplifications  and  identify  those  areas  where  future  study  is  required. 

In  Section  2,  we  specified  that  the  performance  model  terms 
were  limited  to  those  associated  with  an  acceleration  environment.  As 
mentioned  in  Section  3,  a  component  of  centrifuge  rc.te  will  be  sensed 
by  the  platform  sensors  based  on  the  magnitude  of  the  misalignment 
between  the  two  spindle  axes  and/or  variations  in  either  the  main  or 
CRP  drive  system.  Measurement  data  taken  thus  far  on  the  centrifuge 
environment  shows  that  an  expansion  of  the  sensor  performance  models 
is  not  necessary;  however,  since  this  assumption  is  based  on  the  mag¬ 
nitude  of  centrifuge  rate  applied  to  the  sensors  and  their  sensitivity  to 
rate,  an  evaluation  of  this  assumption  must  be  made  for  each  platform 
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tested.  Specific  assumptions  of  the  gyro  and  accelerometer 
sensors  were 

(a)  The  gyro  rotor  spins  at  a  constant  speed  about  an  axis 
of  symmetry 

(b)  The  center  of  mass  of  the  gyro  rotor  coincides  with 
that  of  the  gyro  element. 

(c)  The  gyro  rotor  and  gimbal  support  structure  are  rigid. 

(d)  The  gyro  precession  angle  A  is  maintained  small  by 

O 

the  platform  stabilization  loop. 

(e)  The  accelerometer  output  axis  angle  is  maintained 
at  null  by  the  capture  loop. 

(f)  The  gyro  and  accelerometer  transient  response  can  be 
neglected  based  on  time  constants  of  2  milliseconds  and 
0.3  millisecond,  respectively. 

Assumptions  (a)  through  (o)  will  be  valid  in  most  instances  simply 
because  these  arc  closely  controlled  design  specifications  for  all  plat¬ 
form  sensors  used  in  inertial  navigation  applications.  Assumption  (f) 
is  obviously  related  to  the  measurement  cycle  time  of  the  platform.  In 
the  simulations,  the  assumption  is  valid,  since  the  measurement  cycle 
time  is  much  larger  than  the  normal  criterion  that  the  transient 
response  is  negligible  after  three  timu  constants  (i.e.,  a  time  period 
equal  to  three  times  the  time  constant).  This  is  also  an  area  that  is 
closely  controlled  by  design  specifications  with  respect  to  the  platform 
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operational  measurement  cycle  time.  The  following  assumptions  were 
made  concerning  the  platform  performance  model: 

(a)  The  platform  gimbals  are  rigid. 

(b)  The  2-Hz  frequency  of  the  centrifuge  sinusoidal  accelera¬ 
tion  is  within  the  system-gimbal-servo  response. 

(c )  The  servo  error  is  a  deterministic  quantity. 

Assumption  (a)  is  also  related  to  the  amount  of  centrifuge  rate  applied 
to  the  platform,  since  the  rigidity  of  the  gimbals  is  a  direct  function 
of  the  rate  environment  in  which  the  platform  was  designed  to  operate. 
Assumption  (b)  is  valid  in  most  instances  because  of  the  design  trade¬ 
off  that  must  be  made  between  the  stabilization  loop  gain  and  bandwidth. 
Normal  platform  bandwidths  range  from  5  to  20  Hz,  depending  on  the 
application.  Assumption  (c)  has  been  found  from  experience  to  be  quite 
valid  based  on  servo  tests  and  analyses  conducted  on  numerous  plat¬ 
forms.  Therefore,  it  is  concluded  that,  except  for  those  involved  with 
the  centrifuge  rate  effect,  the  assumptions  of  Section  2  should  be  valid 
in  most  instances  of  platform  testing  on  the  centrifuge.  In  the  case  of 
the  centrifuge  rate  effect,  it  is  recommended  that  additional  simula¬ 
tions  be  conducted  based  on  actual  centrifuge  and  platform  performance 
data  to  determine  what  modifications  are  required  for  the  sensor  and 
platform  performance  models. 

In  Section  3,  it  was  assumed  that  the  inertial  frame  was  non¬ 
rotating  with  respect  to  the  fixed  stars  and  that  any  deviations  of  the 
local  gravity  vector  caused  by  mass  anomalies  were  negligible.  Based 
on  a  calibration  time  of  approximately  4  hours,  the  inertial  frame 
assumption  is  obviously  valid.  The  mass  anomaly  contribution  has 
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been  verified,  by  measurements  at  the  centrifuge  test  site,  to  be 
negligible.  Specific  assumptions  concerning  the  centrifuge  were 

(a)  The  spindle  axes  tilts  were  assumed  to  be  constant 
small  angles. 

(b)  The  dynamic  change  in  the  centrifuge  radius  was 
assumed  to  be  constant  at  a  stabilized  g-level. 

(c)  The  misalignments  and  centrifuge  rate  variations 
were  assumed  to  be  measurable  quanities;  hence,  the 
coordinate  transformations  were  assumed  to  contain 
deterministic  elements. 

(d)  The  platform  axes  were  assumed  defined  by  the  physical 
case  input  axes  of  the  sensors. 

Asssumptions  (a)  through  (c)  are  based  on  preliminary  data  obtained 
from  the  initial  evaluations  of  the  centrifuge.  It  is  important  that 
additional  performance  data  be  obtained  and  evaluated  to  determine  if 
the  dynamic  model  and  coordinate  transformations  defined  in  Section  3 
are  valid.  It  was  mentioned  in  Section  3,  that  if  the  measurement 
accuracy  of  these  centrifuge  parameters  is  not  sufficient  to  accurately 
account  for  the  centrifuge  rate  effect  or  to  determine  the  applied 
acceleration,  then  these  parameters  must  be  estimated  by  the  filtering 
process.  This  assumes  taat  the  basic  form  of  the  dynamic  model  of 
the  centrifuge  is  known,  and  that  specific  parameters  in  that  model 
require  to  be  identified  or  estimated.  Therefore,  it  is  extremely 
important  to  continue  an  evaluation  of  the  centrifuge  performance  data 
to  verify  or  modify  the  assumed  models  and  transformations  of 
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Section  3.  Assumption  (d)  is  quite  common  for  platform  performance 
models,  since  any  error  in  the  mounting  of  the  sensors  is  included  in 
the  sensor  misalignment  angles.  In  the  case  of  the  Group  2  terms  of 
Eq.  (3.25),  these  also  require  additional  evaluations  at  the  higher 
centrifuge  g-levels  to  determine  if  their  contribution  can  be  neglected 
without  affecting  the  accuracy  of  the  error  model  coefficient  estimates. 

In  Sections  4  through  6,  the  following  three  major  assumptions 
were  made: 

(a)  The  statistical  model  assumed  for  the  sensor  parameters 
was  a  random  constant  in  combination  with  a  random  walk. 

(b)  The  operating  random  changes  of  the  sensor  parameters 
were  assumed  to  be  zero  mean,  gaussian  white,  distur¬ 
bance  processes. 

(c)  The  disturbance  process  was  assumed  to  be  independent  of 
the  initial  condition  repeatability  sources. 

Section  4.3  of  Section  4  contains  an  extensive  discussion  concerning 
these  assumptions.  Unfortunately,  nothing  further  can  be  added  here, 
except  that,  if  additional  sensor  data  reveals  that  the  statistical  model 
should  incorporate  correlation,  then  the  simplification  proposed  by 
Bucy  and  Joseph,  described  at  the  end  of  Section  4.4,  becomes  an 
extremely  important  result.  The  alternative  of  adjusting  the  variance 
rather  than  augmenting  the  state  vector  would  be  a  welcome 
simplification . 

All  the  quest. ons  concerning  linearization,  Av  approximation, 
observability,  and  simplifying  the  computation  of  4>  and  T  were 


201 


answered  by  the  simulation  results  of  Sections  5  and  6.  Areas 
requiring  further  study  are  the  effect  of  modeling  errors  in  the  pre¬ 
dicted  filter  loops;  optimization  of  the  filter  performance  with  respect 
to  Q(0),  P(0),  and  R*(l);  and  optimization  of  the  torque  profile  for  the 
1-g  calibration.  The  correlation  patterns,  provided  by  the  off-diagonal 
terms  of  the  filtering  error  covariance  matrix,  are  an  excellent  source 
of  information  for  generating  an  optimal  torque  profile.  It  is  believed, 
based  on  the  simulation  results,  that  the  correlation  patterns  will  show 
that  there  exist  "observaDility  regions"  where  subsets  of  the  model 
coefficient  estimates  are  "optimal,"  based  on  the  geometry  of  the  1-g 
calibration  problem.  Therefore,  an  optimal  torque  profile  would  con¬ 
sist  of  a  prespecified  set  of  commands  that  orient  the  platform  axes 
within  these  regions  in  the  minimum  time.  In  the  case  of  the  centri¬ 
fuge  calibration,  since  the  filter  convergence  is  so  rapid,  it  appears 
that  an  optimal  torque  program  would  consist  of  a  prespecified  set  of 
offset  Euler  angles  to  recover  the  various  types  of  model  coefficients. 
This  concludes  the  summary  and  the  recommendations  for  further 
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APPENDIX  A 


KINEMATIC  ACCELERATION  OF  THE  SENSOR  FRAME 

The  kinematic  acceleration  of  the  sensor  frame  with  respect  to 
the  inertial  reference  frame  is  developed  using  the  basic  equations  of 
Coriolis  and  the  equations  for  differentiating  a  vector  JR. 

The  equations  for  differentiation  of  a  vector  R  are  as  follows: 


JR_  =  _l_r  R  +  wrXR_ 


(A  1) 


R  =  i  R  +  2  (w  X  1  )R  +  u>  X  R 

—  —  r  —  r  -  r  —  r  — 


4  lj  X  (w  X  R) 

—  r  —  r  — 


(A.  2) 


where 

•  •• 

R,  R  -  are  the  scalar  velocity  and  scalar  acceleration  of  R 
w  r  =  angular  velocity  of  the  vector  R  and  r 

=  unit  vector  in  the  direction  of  II 

The  first  term  of  Eq.  (A.  1)  is  the  rate  of  change  of  the  length  of 
vector  R,  and  the  second  term  (whose  direction  is  perpendicular  to  R) 
gives  the  r^te  of  change  of  jl  due  to  the  rotation  The  first  term 

of  Eq.  (A.  2)  is  the  second  rate  of  change  of  the  length  of  vector  JR 
(i.e.f  linear  acceleration  along  R);  the  second  and  third  terms  are 
both  tangential  accelerations;  and  the  last  term  is  the  centripetal 
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acceleration  resulting  from  the  rotation  of  R  and  is  directed  toward 
the  center  of  rotation. 

The  equations  of  Coriolis  for  rotating  bodies  are  as  follows  [7]: 


•  k  •  i 

R  .  =  R..  +  w.  . 

—  ij  —  ij  -ki 


X  R. 
—  ij 


(A.  3) 


••  tr  ••  i  A  V  •  i 

R..  =  R..  +  £>*  X  R  . .  +  2w.  .  X  R.. 

—  ij  —  ij  —  ki  — ij  -ki  — ij 


+  u.  .  X  (w.  .  x  R  . .) 
— ki  —  ki  —  1  j 


(A.  4) 


Equation  (A.  3)  shows  that  the  rate  of  change  of  a  vector  R„,  as  viewed 
from  a  reference  frame  k,  is  equal  to  the  rate  of  change  of  the  vector 
R.„,  as  seen  from  a  moving  frame  i,  plus  the  angular  velocity  of  the 
moving  frame,  with  respect  to  the  reference  frame  crossed  with 

the  original  vector.  Equation  (A.  4)  gives  the  kinematic  acceleration 
of  frame  j  with  respect  to  frame  i,  as  viewed  from  reference  frame  k. 
The  first  term  of  Eq.  (A.  4)  is  generally  referred  to  as  the  "linear" 
acceleration  term,  as  seen  from  the  moving  frame  i,  even  though  it 
may  contain  the  tangential  and  centripetal  components  defined  in 
Eq.  (A.  2).  The  second  term  of  Eq.  (A.  4)  is  the  tangential  accelera¬ 
tion  due  to  the  angular  acceleration  of  the  moving  frame,  with  respect 
to  the  reference  frame;  the  third  term  is  the  Coriolis  acceleration, 
which  is  generated  by  a  change  in  the  direction  of  R„,  relative  to  the 
moving  frame  i,  plus  a  portion  of  the  rate  of  change  of  the  velocity 
X  R.j ,  due  to  a  change  in  magnitude  or  direction  of  the  position 
vector  R  ,j.  The  fourth  term  is  the  centripetal  acceleration  resulting 
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from  the  rotation  of  the  moving  frame  with  respect  to  the  reference 
frame . 

The  basic  coordinate  frames  connecting  the  inertial  frame  to 
the  sensor  frame  are  shown  in  the  vector  map  of  Figure  A.  1 .  All  the 
coordinate  frames  from  inertial  space  to  the  sensor  axes  are  defined 
in  Section  3.  The  basic  coordinate  frames  are  the  major  transforma¬ 
tions  linking  inertial  space  to  the  sensor  axes.  The  intermediate 
transformations  that  are  excluded  from  the  basic  frames  are  essen¬ 
tially  those  frames  that  account  for  misalignments  of  the  physical 
members  of  the  centrifuge,  such  as  the  main  spindle,  the  counter¬ 
rotating  platform  spindle,  and  the  Inertial  Navigation  System  mounting 
fixture. 

The  position  of  the  basic  coordinate  frames  is  described  in  the 
following  vector  equations  {Reference  Figure  A.  1). 


(A.  5) 


=  R  +  R 
— cr  — rs 


(A.  6) 


R 

—  es 


=  R  +  R 
—  ec  — cs 


=  R.  +  R 
—  le  — es 


(A.  7) 


(A.  8) 


The  first  and  second  derivatives  of  Eq.  (A.  5)  are: 


•  r  •  r  •  r 

R  =  Rr  +  R 
—  r  s  — rp  — ps 


(A.  9) 
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(A.  10) 


••  r 

R 

—  r  s 


••r  **r 

=  R  +  Rr 
—  rp  — ps 


Applying  the  Coriolis  Eqs.  (A.  3)  and  (A.  4)  to  Rr  and  Rr  , 

—  ps  — ps 

tively,  gives: 


respec- 


•  r  *  D 

R  =  Rh  +  w  X  R 
—  ps  — ps  —  rp  — ps 


Rr  =  RP  +ir  XR  +  2u  X  RP 
—  ps  — ps  —  rp  — ps  —  rp  — ps 


+  w  X  (u>  X  R  ) 
—  rp  rp  — ps 


(A.  11) 


(A.  12) 


From  Eqs.  (A.  1 1 )  and  (A.  1  2),  Eqs.  (A.  9)  and  (A.  1 0)  become: 


=  R  +  Rp  +  w  X  R 
—  rp  — ps  — rp  — ps 


(A.  13) 


••r 

Rr 
—  rs 


••r 

R  + 

Vo  •  r 

RF  +  w  X 

R 

+  2  w 

—  rp 

—  ps  — rp 

—  PS 

-rp 

xrP 

+  u>  X  (w 

X  R 

) 

-ps 

-rp  -rp 

—  ps 

(A.  14) 


The  first  and  second  derivatives  of  Eq.  (A.  6)  are: 


(A.  15) 


••  r  ••r*  ••c 

R  =  R  +  R 

—  cs  — cr  — rs 


(A.  16) 
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Applying  the  Coriolis  equations  to 


••r 

and  R 
—  rs 


yields: 


•  «lr  m  C. 

R  =  R  +  R  +  u  X  R  +2u 
—  cs  — cr  — rs  — cr  — rs  — cr 


•  r 

X  R 
—  rs 


+  to 

—  cr 


x(wcr>< 


R  ) 
—  rs 


Substituting  Eqs.  (A.  1  3)  and  (A.  14)  into  Eqs.  (A.  17)  and  (A. 


•  r 

R  = 

•  c 

R  + 

•  r 

R  + 

RP  + 

to  X  R  + 

—  cs 

—  cr 

-rp 

—  ps 

—  cr  —  rs 

••c 

R 

=  RC 

+  *Rr 

**n 

+  rh 

+  i  r  X  R 

—  cs 

—  cr 

rp 

-ps 

-rp  —  ps 

,  .c 
+  to 

X  R 

+  2  w 

X  RP 

—  cr  — rs  —  rp  — ps 


+  2  to  x  /  Rr  +RP  +  to  XR  \ 

—  cr  l— rp  — ps  —  rp  — ps  f 

+  to  X(w  XR  )  +  io  X(w  XR  ) 

—  rp  — rp  — ps  — cr  — cr  — rs 


The  derivatives  of  Eq.  (A.  7)  are: 


Mp  f»p  ttn 

R  =  R  +  R 
—  es  — ec  — cs 


(A.  17) 

(A.  18) 

18)  yields: 

(A.  19) 


(A.  20) 

(A.  21) 

(A.  22) 


210 


Applying  the  Coriolis  equations  to  R*g  and  yields: 


Ae  Ae  •  c 

—  es  =  ^ec  +  +  w  X  R 

es  ec  cs  —  ec  — cs 


(A.  23) 


£*  =  R*  tSc  ti'  XR  +  2  „  x  Ac 

es  — ec  — cs  -ec  — cs  -ec  — cs 

+  “  X  (w  x  R  ) 
ec  ec  — cs; 


(A.  24) 


Substituting  Eqs.  (A.  19)  and  (A.  20)  into  Eqs.  (A.23)  and  (A. 24,  gi 


gives: 


iees=ieec+iCcr*Rrrp+RPD8*S.  XR 


+  X  R  +  u  X  R 
r  s  —  rn  — 


—  cr 


rP  — ps  — ec  — cs 
X  R 

rp  -ps 


(A.  25) 


«'es  ■  R'c  *  Rccr  +  Rr  +RP 
es  ec  — cr  — rp  — ps 


+  — ecX— cs  +-cr  X-rs  +  wr  XR 

cs  cr  —  rs  -rp  — ps 

+  2  “*c  *  (-'  r  *  Srrp  +  iPp,  +  Her  X  £rs  *  Srp  X  Rps) 

+  ^crX(|rrptRPp8^rpXRps)t22rpXiPps 

+  -ec  X(-ec  X4s)  +  -cr  X  -crX  — rs)  + -rp  x  (^rpX  •^ps) 


(A.  26) 


The  derivatives  of  Eq.  (A.  8)  are: 


if  =  R*  +  R1 

ib  —  ie  —  es 


(A.  27) 
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(A.  28) 


*«i 

+  R 
—  es 


Applying  the  Cor/.olis  equations  to 


and  R1 
—  es 


yields: 


•  e 

R 

—  es 


+ 


u>  . 

—  i  e 


X  R 


—  es 


(A.  29) 


R  .  =  R  .  +  R  +  W !  X  R  +  2  U) .  X  R 

—  is  — le  — es  — le  — es  —  ie  — es 

+  w .  \  (u ,  V  R  )  (A.  30) 

—  ie  —  ie  — es 


Substituting  Eqs.  (A.  25)  and  (A.  26)  into  Eq.  (A.  30)  gives  an  expres¬ 
sion  for  the  kinematic  acceleration  of  the  sensor  frame,  with  respect 
to  the  inertial  frame,  as  viewed  from  the  inertial  frame. 


••i 

••i 

••e 

••c 

••r  j*n 

R. 

=  R . 

+  R 

+  R 

+  R  +  Rp 

—  is 

—  ie 

—  ec 

—  c  r 

—  rp  — ps 

+  w1 

X  R 

.  ,e 

T  W 

X  R  +  I)C 

•  r 


—  ie  — es  — ec  — cs  — cr  — rs  — rp  — ps 


}© 


+  2“i-x(R'  tB'  .5'  tS'  X  R 

—  ie  ec  — cr  —  rp  — ps  — ec  — cs 

+  w  XR  +  w  X  R  \ 

—  cr  — rs  — rp  —  psl 

+  2w  X  (RC  +Rr  +RP  +w  XR  +w  XR  \ 

—  ec  \ — cr  —  rp  — ps  — cr  — rs  —  rp  — psl 

+  2  Hcr  xfRr_n  +  RP  +  w  XR\+2u>  x  RP 

cr  ^  rp  -ps  -rp  -ps]  -rp  x^ps  J 


XD 
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+  u>  .  x(w.  XR  )  +  U)  X  (o>  XR  ) 
—  le  —  ie  — es  —  ec  —  ec  — cs 


+  w  X  (w  XR  )+w  X(u  XR  ) 
—  cr  cr  —  rs  —  rp  rp  —  ps 


^  indicates  linear  acceleration  terms 

indicates  tangential  acceleration  terms 
®  indicates  Coriolis  acceleration  terms 
indicates  centripetal  acceleration  terms 


J® 

(A. 31) 


where 


R  =  R  +  R  +  R  +  R 
— es  — ec  — cr  — rp  — ps 


R  =  R  +  R  +  R 
— cs  — cr  “rp  — ps 


R  =  R  +  R 
— rs  — rp  — ps 
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APPENDIX  B 


CALCULATION  OF  APPLIED  ACCELERATION 
GROUP  2  TERMS 


The  Group  2  terms  of  the  applied  acceleration  equation  are 
determined  for  both  simulations.  The  Group  2  terms  discussed  in 
Section  3.3  of  Section  3,  and  defined  in  Eq.  (3.25),  are  undesirable, 
since  they  consist  of  platform  rate,  platform  acceleration,  and  higher- 
order  products  and  cross-products  of  the  platform  rate.  The  calcula¬ 
tions  will  show  that  the  Group  2  terms  can  be  neglected  for  both  the 
1-g  and  operating  centrifuge  simulations. 

B.  1  CALCULATIONS  FOR  THE  1-g  SIMULATION 

Since  the  maximum  contribution  will  occur  when  the  coordinate 
transformations  are  all  identity  matrices  I,  we  assume 

C?  =  Cc  =  Ce  =  Cc  =  Cr  =  Cp  S  1  (B*  !) 

•  •  rk  . 

For  the  1-g  simulation,  AW cr  s  O,  so  the  Group  2  terms  reduce  to 


cs  [2Wck  w?k  rP  +  wPk  rP  +  wpk  wPk  rP  1 

PL  le  rp  ps  rp  ps  rp  rp  psj 


(B.  2) 


as  can  be  seen  from  Eq.  (3. 25). 

The  first  calculation  is  to  determine  the  contribution  that  the 

Group  2  terms  make  toward  the  platform  rates  defined  by  Eq.  (2.33). 

We  determine  6w  ,  ,  and&u  based  on  the  variables  defined  in 

xp  yp  zp 

Section  5  for  the  1-g  simulation.  We  first  need  the  acceleration 


Preceding  page  blank 
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applied  to  each  gyro  by  the  Group  2  terms.  Hence,  we  first  select 
the  appropriate  values  of  C®  and  RPg  from  Eqs.  (3.20)  and  (3.18) 
respectively.  An  expansion  of  the  first  Group  2  term  of  Eq.  (B.  2)  is 


0 

-2WES 

2WEC“ 

0 

-CO 

zp 

(0 

yp 

2WES 

0 

0 

10 

zp 

0 

“CO 

xp 

-2  WEC 

0 

0 

m 

-to 

L  yp 

CO 

xp 

0 

RP 

ps 


(B.  3) 


The  second  term  is 


0 


co 


-co 


-CO 


0 


CO 


yp  *p 


CJ 


zp  yp 


xp 


RP 

ps 


(B.  4) 


and  finally  the  last  term  is 


’o 

-GO 

zp 

GJ 

yp 

0 

-co 

zp 

a 

>. 

3 

(a) 

zp 

0 

-CO 

xp 

CO 

zp 

0 

-U) 

xp 

-co  _ 

L  yp 

CO 

xp 

0 

-CO 

L  yp 

co 

xp 

0 

J 

R1 


ps 


(B.  5) 


A  list  of  the  parameters  used  in  the  calculation  is 

WEC  =  6.  12  X  10'5  rad/sec 
WES  =  3.96  X  IQ’5  rad/sec 
g  =  32.  124  ft/sec2 
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n  =  1. 26  X  10  rad 
■x 

o 

ill  =  1.48  X  10" 3  rad 
i 

DjX  =  5.25  X  10"^  rad/sec/g 
Djy  =  4.96  X  IQ'6  rad/sec/g 
=  4.  52  X  10"^  rad/sec/g 

K1X  =  K1Y  =  K1Z  =  1,0  g/g 

The  platform  rate  and  platform  acceleration  values  taken  from  the 
computer  simulation  results  are 


w  = 
xp 

-4.71  X 

10“ 

^  rad/sec 

u  = 

• 

o 

ui 

X 

10" 

^  rad/sec 

yp 

GJ  = 

4.60  X  10"4 

rad /sec 

zp 

• 

u>  = 

xp 

4.47  X  10"8 

rad  /sec^ 

• 

(*)  = 
yp 

-1.69  X 

10“ 

8  rad/sec 

• 

w 

3.  06  X  1 

O 

i 

00 

rad/sec^ 

zp 

where 


Wj  (t  )  -  'u>-  (t  f) 

ip  n  ip  n- 1 
At 


[i  =  x,  y.  z] 


At=t  -t  .=1.0  second 
n  n- 1 


When  the  above  parameters  are  substituted  in  the  expanded  terms 
we  obtain  the  following  values  for  the  acceleration  applied  to  the  three 
gyros. 
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6  A 


SGX 

'is 


6a: 


SGY 


is 


ft  A. 


SGZ 


is 


6aix 

0.  468  X  10"9  g's 

6aox 

= 

-1 . 228  X  10*9  g's 

6asx_ 

1. 939  X  10"9  g's 

m  m 

-  _ 

m  Q  " 

6aIY 

0. 791  X  10'7  g's 

6aOY 

= 

-2.263  X  10-9  g’s 

f'aSY 

-2.  345  X  10"9  g's 

>  ■ 

■  m 

r 

6aiz 

-0.  866  X  10-9  g's 

6aoz 

= 

-1 . 586  X  10'9  g’s 

oasz 

»  m 

1.415  X  10‘9  g's 

From  Eq.  (2.33),  the  delta  platform  rate  equations  are 


6“xp  =  '°IX  6alX 


6wyp  =  ”DIY  6aIY 


6wzp  =  nx  DIX  6aIX  '  DIZ  6alZ 
o 


Substituting  the  values  from  Eq.  (B.6)  into  (B.7)  gives 


6u  =  -2.  457  X  10"^  rad/sec 
xp 

6u  =  -3.  923  X  10"15  rad/sec 

yp 


6u  =  3.917  X  10  ^  rad/sec 
zp 


(B.6) 


(B.7) 


(B.8) 
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Comparing  these  values  with  those  obtained  from  the  computer 
simulation,  we  see  that  the  contribution  of  the  Group  2  terms  is 
11  orders  of  magnitude  below  the  1-g  simulation  rates.  The  Group  2 
term  rate  contribution  can  obviously  be  neglected. 

The  same  procedure  is  used  to  obtain  the  platform  acceleration 
contribution  of  the  Group  2  terms.  The  only  difference  is  that  is 
obtained  from  Eq.  (3.  19)  for  the  accelerometers.  The  acceleration 
applied  to  the  three  accelerometers  is 


6  A 


SAX 


in 


6  A 


SAY 

is 


6  A' 


SAZ 

is 


6aIAX 

1.136  X  10'9  g's 

f,aPX 

r 

-1.966  X  10'9  g's 

.6aOAX. 

2. 398  X  10'9  g's 

.  m 

6aIAY 

0.204  X  10'9  g’s 

6aPY 

- 

-1.291  X  10'9  g's 

fiaOAY 

-1. 839  X  10'9  g's 

•  m 

■*  « 

6aIAZ 

‘  _  q  “1 

-1 . 640  X  10  y  g's 

6apz 

-2.853  X  10‘9  g's 

(63oaz. 

0.  655  X  10'9  g's 

a  « 

(B.  9) 
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From  Eq.  (2.34),  the  delta  platform  acceleration  equations  are 


6AX 

6Ay 

6AZ 


=  K1X  6aIAX 
=  Kly  6aIAy 

K1Z  6aIAZ 


(B.  10) 


Substituting  the  values  of  Eq.  (B.  9)  into  (B.  10)  gives 

6AX  -  1.  136  X  10'9  g's 

6Ay  =  0.204  X  10'9  g's  (B.  11) 

6AZ  -  -1. 640  X  10'9  g's 

These  values  arc  4  orders  of  magnitude  below  che  measurement  noise 
—  -6 

level  of  13. OX  1*0 "  g's.  The  Group  2  terms  can  therefore  be  com  - 
pletely  neglected  for  the  1-g  simulation. 


B.  2  CALCULATIONS  FOR  THE  CENTRIFUGE  SIMULATION 

The  calculations  for  the  centrifuge  simulation  are  quite  similar 

to  the  1-g  case.  The  assumption  of  Eq.  (B.l)  still  holds.  Using  the 

platform  rates  from  the  centrifuge  computer  results  and  a  value  of 

6w  =  3  X  10  ^  rad  / sec  (Reference  Section  3.  1  of  Section  3),  the  maxi  - 

mum  contribution  of  the  AWrk  Wpk  RP  term  of  Eq.  (3.25)  is  0.009  X 

cr  rp  ps 

_9 

10  g's.  Hence,  Eq.  (B.2)  can  represent  the  Group  ''  term  equation 
for  the  centrifuge  simulation. 
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A  list  of  the  additional  parameters  required  for  the  centrifuge 


calculation  i 

& 

Doz  = 

4.52  X 

10  ^  rad/sec/g 

dooy 

=  0.29 

X  10'6  rad  /sec /g^ 

disz  = 

0.  22  X 

10’6  rad /sec /g^ 

K2Y  = 

12  X  10 

-6  .  2 
g/g 

K3Z  = 

3  X  10'( 

6  /  3 

g/g 

KIPX  = 

5  X  10 

-6  .  2 
g/g 

AX  =  0 

AY  =  -10.00020568  g's 
AZ  -*  1.00031805  g's 
“C‘  -  90- 

The  value  of  u>ct  was  based  on  an  analysis  of  the  delta  equations  to  give 
the  worst  case  condition.  The  platform  rate  and  platform  acceleration 
values  taken  from  the  computer  simulation  results  are 

u>  =  -5. 24  X  10  ^  rad/ sec 
xp 

u>yp  =  -5.58X10  ^  rad /sec 
u>Zp  =  -0.94X  10  ^  rad/sec 
u>  =  -4.43X  10  ^  rad/sec^ 

xp 

iyp  -  -3.  17  X  10  ^  rad/sec^ 

£>Zp  =  -3.29X  10  ^  rad/sec^ 
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Note  that  the  platform  acceleration  values  are  2  to  3  orders  of 
magnitude  larger  than  those  of  the  1-g  case.  Because  of  this,  the 
major  contribution  is  from  Eq.  (B.4). 

When  the  above  parameters  are  substituted  in  the  expanded 
terms,  we  obtain  the  following  values  for  the  acceleration  applied  to 
the  three  gyros: 


.  aSGX 
6A. 
is 


6ASCY 

IS 


6ASGZ 

is 


V 

m  m 

0.  163  X  10"6  g's 

Saox 

= 

-0.  085  X  10-6  g's 

,6asx . 

-0.031  X  10”6  g's 

-  " 

/ 

5aIY 

-0.  015  X  10"b  g's 

5aOY 

= 

0.079  X  10"6  g's 

6aSY- 

-0.  165  X  10‘6  g's 

»  ■« 

6aiz 

0.021  X  10"6  g’s 

N 

o 

*o 

-0.  141  X  10"6  g's 

6asz . 

0.  018  X  10'6  g's 

(B. 12) 


The  following  delta  approximations,  which  neglect  second-order  6a 
terms,  were  used  in  the  development  of  the  delta  equations  that  are 
given  next. 
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A(a  +  6a)2  s  2a  6a 


A(a  +  6a)3  a  3a2  6a  (B.  13) 

A(a  +  6a)  (b  +  6b)  s  a  6b  +  b  6a 

From  Eq.  (2.33),  the  delta  platform  rate  equations  are 
6wxp  =  'DIX  6aIX 

6wyp  =  -Diy  6aIY  +  2DOOY  (AZ)  6aOY 
6wzp  "DOZ  6aOZ  "DIS£^AY)  fiaIZ  +  (AZ)  6aSZ^ 

From  the  values  of  Eq.  (B.  12),  the  results  of  Eq.  (B.  14)  are 

6w  =  -8. 558  X  10'13  rad/sec 
XP 

6wyp  =  1.202  X  10'13  rad/sec  (B.15) 

6u>  =  6.795  X  10~*3  rad/sec 

zp 

Comparing  these  values  with  those  obtained  from  the  centrifuge  sim¬ 
ulation  shows  that  the  contribution  of  the  Group  2  terms  is  9  orders  of 
magnitude  below  the  centrifuge  simulation  rates. 

The  acceleration  applied  to  the  three  accelerometers  is 


(B.  14) 
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6alAX 

0.  155  X  10"6  g's 

,  .SAX 

6  A.  = 

is 

6aPX 

-0.  014  X  10‘6  g's 

.6aOAX. 

-0.022  X  10"6  g's 

m 

•  ■■ 

m 

6aIAY 

-0.  024  X  lo'6  g's 

6ASAY  - 

IS 

6aPY 

0.  007  X  10"6  g's 

_6aOAY_ 

-0.  174  X  10-6  g's 

*  m 

- 

" 

ftaIA7 

-0.  019  x  10"6  g's 

,,ASAZ  - 

IS 

*apz 

* 

0.016  X  10"6  g's 

f,aOAZ 

J 

0.  1 10  X  10"6  g's 

When  the  approximations  of  Eq.  (E.  13)  are  used,  the  delta  platform 
acceleration  equations,  from  Eq.  (2.34),  are 

6AX  -  K1X  6aIAX  *  KIPX  |[<AXI  6aPX]  -  [(AZ)  6aIAxl} 

6AY  =  K1  Y  6aIAY  +  2K2Y  (AY>  fiaIAY  (B.  17) 

6AZ.  ^K1Z  f’aIAZ  f  3K3Z  <AZ'26aIA7. 

Substituting  the  values  of  Eq.  (B.  16)  into  (B.  17)  gives 
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(B.  18) 


6AX  =  0.155  X  10'6  g's 

6Ay  =  -0.024  X  10*6  g’s 

6AZ  =  -0.  019  X  10‘6  g’s 

In  the  1 -g  simulation,  the  time  between  measurements  At  is 
1  second;  therefore,  a  direct  comparison  between  the  6A  values  and 
the  13  X  10  k  j,'S(  i  sigma,  of  measurement  noise  is  valid.  In  the 
centrifuge  simulation.  At  0.04  second  and  iJ  X  10"^  g-sec,  1  sigma, 
of  velocity  noise  is  added  each  At  cycle.  Hence,  a  more  valid  com¬ 
parison  would  be  in  the  velocity  domain.  Changing  Eq.  (B.  18)  to  6v 
velocity  values  over  the  measurement  interval  gives 

6v^  6.20  X  10  ^  g-sec 

6vy  -  -0.96X  10  g-sec  (B.19) 

_9 

6vz  -0.76  X  10  g-sec 


These  values  are  3  to  4  orders  of  magnitude  below  the  velocity  mea¬ 
surement  noise  level  of  1  3  X  10*^  g-sec,  1  sigma. 

The  calculations  show  that  the  Group  2  terms  can  be  completely 
neglected  for  the  centrifuge  simulation. 
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APPENDIX  C 


ANALYTIC  PART1ALS 


The  analytic  partials  of  the  state  and  measurement  functions 
for  both  simulations  are  contained  in  this  appendix. 


C.  1  ANALYTIC  PARTIALS  FOR  THE  1-g  SIMULATION 

The  partials  of  the  state  function  are  defined  by  the  following 
(17  X  17)  matrix  of  partial  derivatives. 


FK-1 


A 


(C.  1) 


i»j  =  1  *  2, ...»  17 


where 


f.  -  are  the  elements  of  f(x)  defined  in  Section  5 

i  — 

x(t  .It  .)  -  are  the  filtered  state  estimates 
n-  1  1  n- 1 

The  first  14  rows  of  f(x)  are  zero,  implying  that  the  first  14  rows 
of  F  contain  zero  elements. 

i  --  1  thru  14 

F..  =  O  for  (C.  2) 

j  =  1  thru  17 

Therefore,  only  the  last  three  rows  of  F  need  to  be  evaluated.  The 
following  is  a  list  of  the  nonzero  elements  of  F  in  the  last  three 
rows.  All  elements  not  listed  are  zero. 
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Define 


x.  =  x.(t  -It  -  i  =  1 , 2,  .  .  .  ,  17 
l  i  n-  1  1  n-  1 


E.  .(i,j  =  1,2,3)  -  are  the  elements  of  th<  Euler  transfor- 
^  mation  matrix  E  in  Section  5,  evaluated 

at  x. 


to  ,  co  -  are  the  platform  rate  equations  defined  in 
XP  ZP  Section  5,  evaluated  at  x^ 

C  15  =  cos  (x  j  ^ ) 

C  1 6  =  cos  (x 

C  17  =  cos  (x  jy  ) 

515  =  sin  (xj^) 

516  =  sin  (xj^) 

517  =  sin  (x jy) 

C21  7  =  cos  (2  x  1?  ' 


The  nonzero  elements  of  F  are 


P15  1  =  (*13  S17  "  c  17)/C  16 
F15  3  =  -  S17/C16 

F-,  .  =(2xn  Cl  7  SI  7  SI 6  SI  5  +  x,  ,  Cl  5  C21  7 
15,4  13  13 

-  C  17  E13)/C16 
F15,6  =-  5,7  fi33/C16 
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F15,  13  =  ^2  x4  C17  S17  S16  S15  +  £4  C15  C21 7 
+  Xj  S 17  +  S17  TGX)/C  16 

F15,  15  =  [*4  xJ3(2  C  17  S17  S16  C15  -  S15  C217) 

-  WES  S16  Cl 5  +  WEC  S 16  SI  5  -  x„  C17  E 

4  12 

-  xfe  S17  E32j/C16 

F15,  16  =  [x4  C17  F23(2  *13  S17  “  C17)  -  E^  WEC 

-  223(WES  +  x,  S  17  S 1 7  )1  / C 1 6  +  (S16  C17  u 

J  xp 

+  S16  S17  u/p)/(C16  Cl  6) 

F15,  17  =  [*4  *13(S16  SI  5  C217  -  2  C17  S17  C15) 

+  WES  C  1 5  -  WEC  S 1 5  +  x4  C17  E33 

‘  *6  S17  F13  ‘  "xp  S17  f  “2p  C17J/C16 
F1 6,  1  “  x13  017  +S17 
F16,  3  =-  C17 

F16, 4  =  ^i3(S16  S15  C217  -  2  S17  C17  C15)  +  S17  EJ3 
F16, 6  ='  C17  E33 

F1 6,13  =  x4(S16  SI 5  C217  -  2  SI  7  Cl 7  Cl  5)  +  Cl7(Xj  +  TGX) 
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F16  15  =  *4  X13(S16  C15  C217  +  2  C17  S17  S15  f  015  WEC 
+  S15  WES  -  x6  C17  E32  t  x4  S17  EJ2 

F16, 16  *  =23  [*4  J|3  C217  4  C17  SI7(x4  -  xfc>] 

F. ,  =  -u  C 17  -  £>  SI 7  -  x.  x.,(2  C  17  S17  S16  S15 

1 D |  1  i  Xp  Zp  *  1 J 

+  C 15  C217)  -  WEC  S16  C15  -  S16  S15  WES 


-*6C17  E13-V17  E33 


F17, 1  = 

516  F1S.1 

F17 , 2  = 

.1 

F17 , 3  = 

5,6  F15.3 

F17 ,  4  = 

516  F15,4 

F17 , 5 

-  F23 

F17 , 6  = 

516  F15, 6 

F17 ,  13 

=  S!6  F,5i13 

F17, 15 

=  S16  F15, 15 

F17, 16 

=  S16F15.16 

4  u  C17  + 

*P 

F17 , 17 

=  S16F15.17 

zp 
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The  partials  of  the  mea.urement  function  are  defined  by  the 
following  (3  X  17)  matrix  of  partial  derivatives. 


fi(t  It  ,)1  # 

8h. 

i 

i(*nl‘n-!>] 

L  n 1  n-  1  'J 

ax. 

J 

j  =  1.2, ....  17 


where 

h.  -  are  the  elements  of  h(x)  defined  in  Section  5 
X(tnltn-1)  "  are  the  Predicted  state  estimates 

The  following  is  a  list  of  the  nonzero  elements  of  H.  All  elements 
not  listed  are  zero> 

Define 


i=xi(*n!‘n-l> 


=  1,2,3) 


S15  =  sin(xj5) 


1  -  1.2, ,..,17 

are  the  elements  of  E  evaluated  at  x.’” 


The  nonzero  elements  of  H  are 


Hl,7  =  * 

Hi,  io =  £i3  -  *;4 


Hl,14  =-S10  E2*j 
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Hl,15  si!o<=Iz-*J4  =M> 
Hl,l6=S15x?0<£U  -  £21-H> 
H 1 ,  17  =  -*!0  *33 
H2,  8  =  1 
H2,ll  =  *23 
H2,  15  "  X11  62 

»2.16=S15  *11  E21 
H3,9  "  1 

H  -  P’"' 

h3,  12  "  j3 

_  _  «.  :!<  * 

H3, 15  =  x12  E32 

H3.16=;?2S15  E31 

IJ  _  0*  p-';: 

M3,  17  “  x12  *T3 


C.  2  ANALYTIC  PARTIALS  FOR  THE  CENTRIFUGE  SIMULATION 
The  partials  of  the  state  function  are  defined  by  the  following 
(10  X  10)  matrix  of  partial  derivatives. 


r  ,  A  9f.  x(t  4  It  4  ),t 

m 


(C .  4) 


ii  J  =  1 , 2,  . . .  ,  10 


where 
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fj  -  are  the  elements  of  jf(x,t)  defined  in  Section  6 

x(t  .It  . )  -  are  the  filtered  state  estimates 
n- 1 1  n- » 


As  in  Section  C.  1,  only  the  last  three  rows  of  F  are  required  to 
be  evaluated,  since  the  first  seven  rows  contain  zero  elements. 


i  =  1  thru  7 

F  .  =  O  for  (C.  5 

*  j  =  1  thru  10 


The  following  is  a  list  of  the  nonzero  elements  of  F  in  the  last  three 
rows.  All  elements  not  listed  are  zero. 

Define 


*i  =  *i(tn-lltn-l)  i  =  i  ,2 . 10 

A 

E..(i,j  =  1,2,3)  -  are  the  elements  of  the  Euler  transformation 
J  matrix  defined  in  Section  6,  evaluated  at  x. 

w  ,u  -  are  the  platform  rate  equations  defined  in  Section  6, 
XP  ZP  evaluated  at  x. 

i 

A  A 

AX.AY.AZ  -  are  the  elements  of  the  applied  acceleration 

(AX,  AY,AZ)  defined  in  Section  6,  evaluated 

at  E. . 
ij 

Djy.  Dqz»  Djxi  G1 ,  G2,  wct  -  are  parameters  defined  in 

Section  6 


x6E  x4 


CIO  =  cos  (x,q)  =  cos  (Xg) 


Cll  =  cos  (x<  j)  =  cos  (x^) 


C12  =  cos  (xj2)  =  cos  (xjq) 


510  =  cos  (xjq)  E  cos  (xg) 

511  =  cos  (xjj)  E  cos  (Xg) 

512  -  cos  (xj2)  =  cos  (xjq) 

The  above  identities  are  based  on  the  structure  of  the  centrifuge 
simulation.  As  explained  in  Section  6,  there  are  12  state  variables 
that  are  structured  into  a  10- element  state  vector  for  three  different 
options  of  the  simulation  program.  Therefore,  the  above  identities 
show  the  relationship  between  the  state  variables  and  the  elements  of 
the  state  vector  for  the  F  partials.  The  state  vector  represents 
different  state  variables  for  each  option,  implying  that  the  analytic 
partials  will  be  different.  The  changes  for  each  option  are  identified 
below. 

Define 

C  =  cos  (w  t) 
c 

S  =  sin  (u  t) 
c 

G  =  1.0  +  G2*S  where  *  represents  the  product  of  the  two 
variables . 

G1E13  =  G1*E13*S  +  E12*G 

WECE13  =  WEC*E13  -  WES*E12 

G1E23  =Gi*E23*S  +  E22*G 


G1E33  =  G1*E,,*S  +  E,  ,*G 


WECE33  =  WEC*E33  -  WES*E32 
G1S11  =  G1*(S11*C  -  E22>KS)  +  E23*G 

Gicii  =  gi*(cu*c-  cio*e2j*s)  +  sio*e21*g 

G1E21  =  G1*»E21*C  +  E22*S)  -  E23:;G 
WECE22  =  WEC*E22  +  WES*E23 
G1E31  =  G1*(E31*C  +  E32:I:S)  -  E33-G 
WECE32  =  WEC*E32  +  WES*E33 
G1E11  =  Gl:!t(Ej  j*C  +  E12*S)  -  E13*G 
WECE12  =  WEC*E12  +  WES-E13 


For  the  Basic  Option  we  define 


x3  =  Xj 


The  nonzero  partials  for  the  Basic  Option  are 


F„  .  =  -C  12/Cl  1  *  AX 

8,  1 


8,4 


8,8 


•  S12/C1  1*AZ*AY 

|ci2(-x3*GlE13  +  WECE13)  +  S12  f-Doz*GlE13 

l  ^ 

-  x6(A*Z*G1E23  +  AY*Gl E33 )  +  WECE33j|  /Cll 
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1,9  =  |c12[ci2(-x3*G1S11  -  WECE22)J 

+  SI  2^-Dqz*C12*G1S1  1  -  x^(AZ*GlCll 
-AY>:S12j:GlE21)  -  S12*WECE22]  J  /Cll 
+  sn(fixp*cl2  +  wzp*S12)/(Cll*Cll) 


F8,  10  =  |ci2(-x3>!cGl  E31  +  WECE32)  -  S12*u> 


xp 


+  S12(-D0Z^G1E31  +  x6*AY*G1E11 
-  WECE12)  +  w  *C12!/CU 

zp  I 


j  =  S12>;  AX 


F<)t4  =  -C12*AZ*AY 

F9,8  =  C12["DOZ*G,E13  ‘  x6(AZ*G1E23  +  aY*G1E33) 
+  WECE33J  -  S12(-x3*G1  E13  +  WECE13) 


F9,  9  =  c12^-doz*c12*G1S11  -  x^( AZ*G1C  1 1 

-  AY*S12*GlE21)  -  S12*WECE22j 
-S12  |c12(-x3*G1S1  1  -  WECE22)j 

F9,  10  ~  cl2(-Doz’!'GlE3  1  +  x6*AY>' G1  El  1  -  WECE12 
““Xp)  "  S12(-x3*G1E31  +  WECE32  +  £,  ) 

F10,l  =  S,1*F8.1 
P10,3  =-AZ*AZ 


236 


F10,4  "  S1^  *  8,4 


F10,8  =S11:;,F8,8  "  DIY*GiE23-  2x5*AZ*G1E33 


+  WEC=:  E23  -  WES^E22 


f1q  9  =  Sli*Fg  9  -  DIY5^G1C  1 1  +  2x5*AZ*SI2*G1E21 

•E5<(WEC  :C10  +  WES*S10)  +  w  *C12+u  *S12 
21  xp  zp 

FIO,10  'Sll  rF«.10+2x5"  A‘Z  01E" 


For  Option  1  we  define 


x3 


The  nonzero  partials  for  Option  1  are 


Fg  j  -  -C12/C  1 1 


=  S12 


F 


10,1 


S 1 1 


All  the  rest  of  the  partials  of  Option  1  are  identical  with  those  of  the 
Basic  Option  with  =  Dj^. 

For  Option  2  we  define 


x 


3 
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The  nonzero  partials  of  Option  2  are 

Fg  2  =  -C  12/C  1 1*AX 
F9  2  =  SI 2* AX 

F10,  2  =  S11*F8,  2 

All  the  rest  of  the  partials  of  Option  2  are  identical  with  those  of  the 
Basic  Option  with  Xg  = 

The  partials  of  the  measurement  function  are  defined  by  the 
following  (3  X  10)  matrix  of  partial  derivatives. 


i  =  1.2,3  j  =  1,2, ....  10 


where 


h.  -  are  the  elements  of  h(x,t)  defined  in  Section  6 
x(tn|tn_j)  -  are  the  predicted  state  estimates 


The  following  is  a  list  of  the  nonzero  elements  of  H.  As  was  the 
case  for  the  F  matrix,  the  structure  of  H  is  based  on  the  program 


Define 


=  *i<tnltn-l)  i  =  1,2, . . . ,  10 

*  ^  ^  jj* 

E.j(i,j  =  1,2,3)  -  are  the  elements  of  E  evaluated  at 


X9  =x7 

ax*,aV,az* 

K1X,K1Y’  K1Z 

C  =  cos  (u  t  ) 
c  n' 

S  =  sin  (cj  t  ) 
c  r. 


-  are  the  elements  of  the  applied  acceleration 
evaluated  at  Ej. 

-  are  parameters  defined  in  Section  6 


G  =  1.0  +  G2*S 

C10,C11,  etc.  -  are  the  same  as  for  the  F  partials  with 
x.  replaced  by  x? 


Let 

__  *  >Je 

AX  =  AX 
AY  =  AY 
AZ  =  AZ* 

Ejj  =  Ejj  for  i,  j  =  1,2,3 

I 


Define 


X4X9  =  -  Xg*AZ 

X9AX  =  x9=:<AX 

G1E33  =  G1*E33*S  +  E32^G 

G1E21  =  G1(E21*C  +  E22*S)  -  E23*G 

G1E11  =  GMEjj’f'C  +  E12*S)  -  E13*G 

K1Y2X7  =  Kly  +  2x?  *  AY 

K1Z3X8  =  Klz  +  3xg*AZ*AZ 

For  the  Basic  Option  we  define 


The  nonzero  partials  for  the  Basic  Option  are 

H1,2=AX 

Hj  7  = - AX* AZ 

Hl,8  =  <g1*ei3*S  +  E12*G)*X4X9  -  X9AX*GlE33 
Hj  9  = -GlE2i(C12*X4X9  -  X9AX*S12) 

H1  10  =  (G1*E31*C  +G1*E32*S  -  E33*G)*X4X9 

+  X9AX*G1E11 
H2  5  =  AY*AY 
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H2,  8  =  {G1*E23*S  +  E22*G)*K1Y2X7 

H2,9  =  [G1(C11*C  -  C10*E21*S)  +  S10*E21*gJ*K1Y2X7 

H3, 6  =  <AZ>3 

H3,8  =  G1E33*K1Z3X8 

H3,9  =  "S12*G1E21*K1Z3X8 

H3,  10  =  -G1E11*K1Z3X8 

Option  1  partials  are  identical  to  those  for  the  Basic  Option. 
Eor  Option  2  we  define 


*4  “  K1X 
Hl,l  =  1-° 


and  the  partials  are  identical  to  the  Basic  Option  with  x  =  K 

4  1 X 

This  completes  the  analytic  partials  for  the  centrifuge 
simulation. 
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